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V. FOREWORD 


This volume of the "Onboard Utilization of Ground Control Points 
for Image Correction" final report provides a detailed description 
of the software that was developed to simulate the ground control 
point navigation system. Three other volumes have been incorporated 
into the final report. Volume I provides an executive summary, Volume 
II contains a detailed description of the study and simulator results, 
and Volume IV is an appendix describing software utilized for image 
correction accuracy measurement. 
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1.0 INTRODUCTION 


The Ground Control Point Simulation Program (GCPSIM) has been designed 
an analysis tool to predict the performance of the navigation system 
illustrated in Figure A-l . The system consists of two star trackers , a GPS 
receiver, a gyro package, and a landmark tracker. 



Figure A-l System Configuration 








The program has been configured to provide an extensive error analysis 
rather than simply a covariance analysis. A covariance analysis provides a 
great deal of information but in many cases this Information Is inaccurate and 
misleading. For example, there are cases where the covariance matrix 
converges over a period of time while the actual state diverges. These types 
of Instability are common in Kalmar filters and without direct knowledge of 
the state error conclusions can be inaccurate. For this reason, GCPSIM has 
been designed to model the true state of the vehicle using the dynamic 
equations of motion. By propagating the true state, it Is not only possible 
to perform a covariance analysis, but to generate the actual state error and 
measurement residuals as well. 

GCPSIM has been designed to accept either simulated GCP measurements or 
measurements that have been extracted directly from corrected Landsat 
imagery. These capabilities are included to allow r^alysis over long periods 
of time as well as to demonstrate the feasibility. 

REPORT FORMAT 


The intent of this document is to give visibility to the GCPSIM code. 
GCPSIM uses top-down structured programming aided by visual control logic 
representation (VCLR) . A total system hierarchy diagram aids in depicting 
the relationship between the modules. 

Each module is presented separately with a general discussion of the 
function performed followed by requirements, algorithm and process, VCLR, and 
source code (Fortran IV) . The remainder of this section will describe the 
VCLR presentation aid. 

Visual Control Logic Representation (VCLR) 

VCLR charts give control logic which is compatible with structured 
programming. It offers many advantages and flowcharting. 

1) Only the standard constructs are used. 

2) The total scope and impact of the logic can be seen and easily 
understood. 

3) No extraneous symbols, connections, or notations are used. 

VCLR provides visible control logic representation which is a picture of a 
software design. Its primary purpose is to enable software engineers to 
express their thinking visually. Concentration is on the control logic of the 
design. 

Standard constructs in visible control logic representations are the same 
as those for pseudo-code: SEQUENCE, IFTHENELSE , DOWHILE, DOUNTIL and DOCASE. 

Only the representations differ. 
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SEQUENCE - A SEQUENCE it simply one standard construct or one single 

statement followed by another. If "P1 M and "P2" are standard 
constructs or single statements! the sequence would appear in a 
visible control logic representation as: 


PI 


P2 


IFTHENELSE - Consists of a true/false test, and a path for each state. The 
true path appears on the left side, under the "T". One of the 
paths may be a "do-nothing" or "NULL" path. One or both paths 
must consist of a standard construct or of a single statement. 

If "Cl" is the condition being tested, "PI" is the true path and 
"P2" is the false path, the IFTHENELSE construct would be 
written as 



DOWHILE — The DO WHILE is a loop with these characteristics: 

1) The counter or other item to be "incremented" is 
initialised before entering the loop. 

2) The test is performed at the beginning of the loop. The 
conditions which must exist in order for the loop top be 
executed are the conditions which appear in the DOWHILE 
test. 

3) The item to be executed must be a standard construct or a 
single statement. 

4) The counter is incremented or other increment -like action 
is generally taken (e.g., another line is read) at the end 
of the loop. 

If "Cl" is the condition which must exist for the loop to be 

executed, and "PI" is a standard construct or single statement, 

the DOWHILE world be written as follows: 


DOWHILE Cl 


PI 






DO UNTIL - Tbi DOUNTIL is i loop with those chsrsctsristics : 

1) Ths counter or other item to be "incremented" is 
initielised before entering the loop* 

2) The test is ?«erformed st the end of the loop. The 
conditions which oust exist in order to exit from the loops 
ere those which sppeer in the DOUNTIL test. 

The item to be executed smst be s standard construct or a 
single statement. 

4) The counter is incremented or other increment -like action 
is generally taken (e.g., another line is read) at the 
beginning of the loop. 

If "Cl" is the condition which must exist to exit from the loop, 

and "PI": is a standard construct or single statement, the 

DOUNTIL would be written as follows: 



DOC ASK - 


Use the DOCASE construct when you want to execute a different 
•et cf statements for each of several different values of a 
variable. 


If "Cl" is the variable being tested, and if "Cl" may have 
values of 1, 2 or 3, the construct appears as follows: 


DOCASE Cl 


PI P2 P3 P4 



Example A 


Example B 


Example "A" is equivalent to the nested IFTiJSNELSE form shown 











TOTAL SYSTEM HIERARCHY DIAGRAM 


The total system hierarchy diagram (Figure A-2) is designed to illustrate 
the functional structure of GCPSIM. The upper most block is the main program 
responsible for simulation control. The eleven blocks imediately below this 
type block represent the subroutines called by the main program. These 
programs in turn call subroutines or the next level down and so forth. 

This report has been separated according to a functional decomposition of 
the program. Each of the eleven main subroutines are described in separate 
chapters along with all the subsequent tasks with which they interact. For 
example, the chapter describing the generate measurement module, MEASURE, is 
broken into three main sections corresponding to each of the measurement types 
generated. 
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2.0 GCP - Executive Program 

The executive program, GCP, is designed to control the entire timulation 
from data initialisation to the end of a run at TSTOP. The main program 
provides for two nodes of operation. The first node node Is the measurements 
from each sensor whereas the second mode replaces the modeled GCP measurements 
with actual measurements taken from landsat data. Figure A-3 is a VCLR 
describing the process. 

At the top level, the two modes of operation appear to be identical and 
will be discussed as such. First, simulator initialisation is performed 
within INDATA. This process consists of loading the epoch state and time, and 
initialising all noise parameters, and setting up the measurement sequence 
tables. The sequencer, GCPSEQ, determines the type and time of the next 
measurement to be made. The types of measurements available are GPS, Star 
Tracker, and landmark tracker. The true vehicle position state is then 
propagated forward to measurement time by GENENV. GENENV also simulates the 
gyro output in small increments up to measurement time at TMEAS, and 
propagates the true attitude state. Within this propagation loop the 
simulated gyro outputs are processed by GYRO to compensate for gyro bias, 
scale factor, non-orthogonality, and misalignment, and to update the 
quaternion. In the second mode of operation this module controls the 
scrolling of imagery across a video monitor to simulate the sensor front end. 

Following true state propagation the appropriate measurement is generated 
by MEASURE. MEASURE uses a geometry model and the true vehicle state to 
geneiate on ideal measurement. The ideal measurement is then corrupted with 
bias, noise, and misalignment, and compensated for knowledge of these terms. 
The primary difference between the two modes of operation occurs during 
measurement generation. In the second mode, the measurement generation 
module, MEAS, interacts with a separate program running on the PDP 11/70 which 
performs the GCP extraction. 

The estimated state is propagated to measurement time by the module INTC. 
This propagation is actualy part of the extended Kalman filter, but is kept in 
a separate module for efficiency. INTG also propagates the state transition 
matrix and the process noise forward in time. 

EST uses the simulated measurement, the propagated state estimate, the 
process noise, and the state transition matrix to generate a new state 
estimate based on the latest measurement. The new state estimate and 
covariance matrix are printed, and the entire process beginning with 
measurement sequencing is repeated until the end of a simulation run 
identified by TSTCP. Prior to exiting, a plot file is created so that plots 
of state error, covariance, and measurement residual, may be obtained. 
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Figure A- 3 GCP VCLR 
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_DBA0: [01 1R. GCP] GCP. FOR; 36 


0042 

0043 


0044 

0045 

0046 


0047 

0048 

0049 

0050 


0051 


0052 


0053 

0054 


0055 

0056 


0057 

0058 

0059 


0060 


0061 

0062 


0063 


OPEN( UNIT *6 , R C0RDblZE=1 32 , T VP E» ‘ NEW 1 ) 

OPEN ( U N I T * 1 2 . RECOROSiZE = 760 f TvPE"‘N£W' ) 

C WRITE! 5,2) 

C 2 FORMAT ( ' INPUT RUN TITLE (MAX. 40 CHAR) : ' ,t) 

C READ(5 .4)( AT 1TLEI I ) . i-1 .40) 

4 FORMAT (40A1) 

5 FORMAT ( /// , 5 X , 40 A 1 ) 

OPEN! UNIT* 1 3 .NAME* 'GAIN. OAT ' .RECORDS IZE»98 .TYPE* 1 NEW 1 ) 

C. 

C INITIALIZE DATA 



CALL INOATA 

WRITE! 12,4) ( ATITLE ( l I . I* 1 .40) 

WRITE! 6.5) ( A TITLE I I ) . 1 = 1 .40) 

ICALL * 0 



C PRINT INITIAL PARAMETERS 



CALL OUTDATA ( ICALL ) 



C SET UP FORCE MOOELS 



CALL 0NAV(TIM..X.XD,1DUMMV) 

c. ...... 

C INITIALIZE operating flag to true 



ISKIPNsO 

GO TO (10. 40). MOP 

c» 

C PREFLIGHT SIMULATION 

C (SIMULATED GCP MEASUREMENTS) 

C... ........ 

10 CALL GCPSEQ I SEQUENCE MEASUREMENTS 

FLAG « .FALSE. ! INITIALIZE NEW MEAS. FLAG 



C COMPUTE TIME OF MEASUREMENT 

C 

C 

C PROPAGATE TRUE VEHICLE STATE ANO PROCESS 

C GYRO DA r A TO MEASUREMENT TIME 

C... .......................... 

20 CALL GENENV(FLAG) ! GENE PAT E GYRO OUTPUT 

CALL GYRO 

I F ( T I ME 4- .01 .LT. TMEASi GO TO 20 

C* 

C GENERATE MEASUREMENT 

c . ...... ............ 

CALL measure 

C INTEGRATE FILTER STATE TO MEASUREMENT TIME 



30 CALL I NTG 

IF( TIN .01 .LT. TMEAS) GO TO 30 

c. ................................... 

C PERFORM STATE ESTIMATION 

* *•••***•*••• 

CALL EST 


GCP 
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Pag* S 


0064 


0065 


0066 


0067 

0068 


0069 

0070 

0071 


0072 

0073 

0074 


0075 

0076 


0077 

0078 


0079 


0080 


0081 


ICALL • 0 



c print output data 

c .. 

CALL OUTDAT A ( ICALL > 



C PROCESS MEASUREMENTS UNTIL TIME'TSTOP 

c« 

IF(TIME.LT.TSrOP| GO TO 10 



c generate plot tape 



call pltdata 
GO TO 110 

C* ••*••••••»•«•••*•«•••••• 

C POSTFLIGHT SIMULATION 

C*. ........ •••....•«*.. ••••••• 

40 I GCP • .FALSE. 

CALL GCPSEO 
FLAG • .FALSE. 



C COMPUTE time OF MEASUREMENT 

C 

c 

c PROPAGATE TRUE VEHICLE STATE AND PROCESS 

C GYRO OATA TO MEASUREMENT TIME 

C 



220 CALL GENENVI FLAG) 1 GENERATE GYRO OUTPUT 

CALL GYRO 

I r ( TIME ♦ .01 .LT. TMEAS) GO TO 220 

c. ............................................................ 

C generate MEASUREMENT 



CC ALL MEAS 



C INTEGRATE FILTER STATE TO MEASUREMENT TIME 

C. 

230 CALL I NTG 

I F ( T I N ♦ .01 .LT. TMEAS) GO TO 230 



C PERFORM STATE ESTIMATION 

C....« ..»..* 

CALL EST 
ICALL » 0 



C PRINT OUTPUT OATA 

C. ................................................ ............ 

CALL OUTDAT A ( ICALL) 

C*. •••••«. «... .......................................... ...... 

C PROCESS MEASUREMENTS UNTIL TIME»TSTOP 



IF ( TIME .LT. TSTOP) GO TO 40 



C GENERATE PLOT TAPE 

C. ...... 

call pltdata 


p«0« 


GCP 


0082 

1 1 0 

CONTINUE 

0083 


C LOSE ( UNIT •fl.OISPGGE*' SAVE* ) 

0084 


close ( unit ■ 1 3.01 spose** save 1 ) 

0085 


CLOSE! UNIT-1 2 .01 SPOSE* ' SAVE' ) 

0086 


CALL EXIT 

0087 


ENO 


8“ Apr- 1 981 12:35:57 VAX-11 FORTRAN V2.0-2 
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PROGRAM SECTIONS 



N» me 

Bytes 

0 

SC ODE 

454 

1 

SPOATA 

24 

2 

Slocal 

1 84 

3 

COntrl 

12 

4 

T I ME 

1 36 

5 

AS T ATE 

160 

6 

R0TA1 

72 

7 

NO ISE 

216 

8 

NS TATE 

1 12 

9 

OE BuG 

8 

10 

pm i a 

7176 

1 1 

PM IN 

1440 

12 

ARRAYS 

1096 

13 

UPOT 

752 

14 

RESIDUALS 

96 

15 

title 

40 


ENTRY POINTS 


Address Type 

Name 

0-00000000 

GCP 


A t t r i tJU t#» 


PIC 

CON 

PEL 

LCL 

SHR 

EXE 

RD 

NOwRT 

LONG 

PIC 

CON 

REl 

LCL 

SHR 

NOEXE 

PD 

NGWRT 

LONG 

PIC 

CON 

pel 

LCL 

NOSHR 

NOEXE 

PD 

WRT 

LONG 

PIC 

3VR 

rel 

G8L 

SMR 

NOEXE 

RD 

WRT 

LONG 

PIC 

DVR 

rel 

GBL 

SHP 

NOEXE 

PD 

WRT 

LONG 

PIC 

JVR 

rel 

GBL 

SHR 

NOEXE 

PD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

PD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHP 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 


VARIABLES 


Add-es-i 

Type 

Name 

7-OOOOOOC0 

R*8 

BPE 

4-00 000068 

R*8 

DTA 

1 4-00 0000 1 0 

R*8 

OZHST 1 

14-00000028 

R*8 

DZ VST 2 

9-00 000004 

1*4 

IOEBUG 

2-00 00001 C 

1*4 

ISKIPN 

8-00000060 

R*8 

raom 

4-00 000000 

R*8 

TIME 

4-00000060 

R*8 

TISN 

4-00 OOOOSO 

R*8 

TRACK 


Addrer* 

T yoe 

Name 

4-0000: 036 

R *8 

OATEO 

4 -coco: 030 

P *8 

OTN 

14-OGOOCC20 

R *8 

0ZMST2 

2 - 0 C C 0 0 0 0 C 

L *4 

flag 

2-00000018 

I *4 

I DUMMY 

3-00000000 

I *4 

MQP 

7 -00000 0D0 

R*8 

SRE 

4-00000028 

R *8 

UN 

4 -00000048 

p*a 

tmeas 

4 -00C 00010 

R *8 

TSTOP 


Address 

T ype 

Name 

4-00000070 

R*8 

DATER 

4-00000080 

R*8 

DTPRINT 

1 4-00 0C0008 

R*8 

DZVLM 

2-00000010 

1*4 

I 

9-OOOCOOOO 

1*4 

I ENTER 

IO-OOOOICOO 

R*8 

QMAX 

7—00 OOOOCO 

R*8 

SRM 

3-00000004 

R*8 

TINT 

4-00000008 

R*8 

TNEXT 

4-00000040 

R*8 

TZERO 


Address 

Type 

Name 

4-00000020 

R * 8 

DEL 

1 4 -C 00 00000 

R • 8 

DZHLM 

1 4-GCOOOO 1 8 

R *8 

DZ VST 1 

2-00000014 

I *4 

ICALL 

2-00000020 

I *4 

IGCP 

8 -COOCOO 68 

R *8 

RACE 

4-00000018 

R *8 

TI A 

4-000CC058 

R *8 

TIS 

4-00000078 

R *8 

T PRINT 


GCP 


ARRAYS 


Address 

Type 

Name 

By t es 

D i mens Iona 

15-00000000 

L*1 

ATITLE 

40 

(40) 

7-00000060 

R*8 

80 

24 

(3) 

7-00 000090 

R«a 

BOO 

24 

(3) 

7-00000030 

R«8 

BSF 

24 

(31 

7-00000000 

R*8 

BWO 

24 

(3) 

lO-OOOOOCOO 

R* 8 

COVA 

2048 

( 16 , 16) 

11-00000360 

R *8 

COVN 

2 88 

(6, 6} 

5-00 C00070 

R«8 

D 

24 

(3) 

5-00000088 

R*8 

DD 

24 

(3) 

5-00000000 

R«8 

DE 

32 

(4) 

6-00000030 

R*8 

OTHE 

24 

(3) 

6-00000018 

R»8 

OTMEM 

24 

(3) 

6-00000000 

R*8 

OTHR 

24 

(3 ) 

1 4-00 000030 

R»8 

DXMGPS 

48 

(6) 

5-00 OC0020 

R*8 

E 

32 

( 4 ) 

2-00000000 

:»4 

iothem 

12 

(3 1 

1 0-00000000 

R*8 

PA 

1 28 

(4, 4) 

10-00000200 

H *8 

POA 

512 

(4. 16) 

1 1 -00 000 1 20 

R*8 

PON 

288 

(6, 6) 

10-00000400 

R*8 

PHI A 

2048 

(16. 16) 

1 1-00000240 

R»8 

PHIN 

288 

(6. 6) 

1 1-0C 000000 

R»8 

PN 

288 

(6. 6) 

10-0C 001400 

R*8 

POA 

2048 

(16. 16) 

1 1-00 000480 

R*8 

PON 

283 

(6. 6) 

1 3-00 000080 

R«8 

0 

288 

(6. 6) 

1 3-00000030 

R*8 

QA 

1 28 

(16) 

13-00000100 

R*8 

OOOT 

288 

(6. 6) 

13-'i0000000 

R«8 

ON 

48 

(6 ) 

7-00000078 

R« 8 

SO 

24 

(3) 

7-000000*8 

R*8 

SDO 

24 

(3) 

5-00000058 

R*8 

SF 

24 

(3) 

7-00 000048 

R*8 

SSF 

24 

(3) 

7-00000018 

R*8 

SWD 

24 

(3) 

12-00000090 

R*8 

T 1 

24 

(3) 

12-00000098 

R*8 

Til 

72 

(3. 3) 

12-00000018 

R*8 

T 2 

24 

' 3 ) 

12-00000030 

R*8 

T3 

24 

(3) 

12-ooooooeo 

R • 8 

T 33 

72 

J. 3) 

12-00000048 

R*8 

T4 

80 

(10) 

1 2-00000128 

R*8 

T 44 

1 28 

(4. 4) 

12-000003E8 

R*8 

T5 

32 

(4) 

1 2-00000408 

R*8 

T 6 

32 

(4) 

12-000001 AB 

R*8 

T66 

288 

(6. 6) 

12-00000428 

R * 8 

T7 

32 

(4 ) 

1 2-00 0002C8 

R*8 

T 77 

288 

(6. 6) 

10-00000080 

R*8 

TA 

384 

(4. 12) 

5-00000040 

R*8 

MO 

24 

(3 ) 

8-00000030 

R»8 

X 

48 

(6) 

8-00000000 

R*8 

xo 

48 

(6) 







Page B 


GCP 


e-Apr -1901 12 : 35:57 
8-Apr-i98i 12 : 33:02 


VAX-11 FORTRAN V2-0-2 
_DBAO: [ D 1 1R.GCPJGCP. FOR; 36 


LABELS 

Address 


Address Laoe 1 


Address Label 


Address Label 


Address Label 


Address 


1-00000000 4 ' 

0—00 000 1 AO 110 


1-00000005 5' 

0-00000131 220 


0-000000A4 10 

0-000001 5A 230 


O-OOOOOOAD 20 


0-000000DD 30 


0-000001 25 


FUNCTIONS AND SUBROUTINES REFERENCED 

DNAV EST FORSCLOSE FORSEXIT 

INDATA INTG MEASURE OUTDATA 


FORSOPEN GCP SEO 

PLTDATA 


GENENV Gyro 


Total Space Allocated • 11978 Byte* 


COMMAND QUALIFIERS 
fortran /L GCP 

/CHECK* (NO SOUNDS .OVERFLOW) 

/F77 UG /NOG^FLOAT 1NG / 1 4 /OPTIMIZE /WARNINGS /NOO.LlNES /NOMACHINE .CODE /CONT INUATIONS-19 


COMPILATION STATISTICS 


Run T ime : 
Elapsed Time: 
Page Faul tsl 
Dynamic Memory: 


3.00 second* 
12.04 second* 
196 

51 pages 


Label 

40 


2.1 


INITIALIZE DATA MODULE (INDATA) 


The Initialize Data module shall perform the basic functions of the 
telemetry up“link to the spacecraft. It will initialize and reinitialize both 
attitude and navigation states; the lunar ephemeris, the command sequence 
tableSf and the time reference. When the sequence tables are reinitialized! a 
flag is set and the sequencing reverts to the beginning of the tables. 

A data file is read so that only changes to the standard base need to be 
input. In addition to inputing data this module will transform attitude data 
in terms of Euler angles (more convential) to identical attitude data in terms 
of quaternions. 


The attitude parameter transformation is; 


e o 

m 

cosf 

008 

2 

cos | 

+ 

• „ X 

sin — 
2 

sin — 
2 

sin 

2 

e l 

- 

cos ^ 
2 

0 

cos 2 

sin ^ 

- 

sin f 

sin 

2 

cos -£ 
2 

e 2 

m 

cos — 
2 

sin-^ 

2 

cos | 

♦ 

• inf 

cos — 
2 

sin •£ 
2 

e 3 

- 

• inf 

0 

cos- 

cos | 

- 

cosf 

sin 

2 

sin 

2 


The coordinate trunformation for the covaria.ise matrix (P) is computed by; 


Peo - e3 ■ 4>P$T 


Where, the transition matrix $ is computed from the above quaternion 
Euler angle relationship 


3 e n 

3en 

3e n 

3x 

36 

3$ 

3ei 

3ei 

l£l 

3x 

36 

3<J) 

l£2. 

3e2 

3e? 

3x 

30 

3 $ 

9en 

3e^ 

3en 

3x 

30 

3 <p 
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00100 

0001 

00200 

0002 

00100 

0003 • 

00200 

• C 

OC 300 

• c 

00400 

• c 

oosoo 

• C 

006C0 

• C 

00700 

• c 

00 300 

0004 

00400 

0005 • 

00400 

0006 • 

00400 

• c 

00400 

• c 

0C400 

• C 

00400 

• C 

0C400 

• c 

00400 

• C 

00400 

• c 

00400 

• c 

00400 

* C 

00403 

0007 

ocsoo 

0008 • 

oosoo 

0009 • 

OOSOO 

• C 

ocsoo 

• C 

oosoo 

• C 

OOSOO 

• C 

ocsoo 

• C 

oosoo 

• c 

oosoo 

• c 

oosoo 

• c 

oosoo 

0010 

00600 

0011 • 

00600 

0012 * 

00600 

• c 

00600 

• c 

00600 

• c 

00600 

• c 

0060C 

• c 

00600 

• c 

00600 

• c 

00600 

0013 

00700 

0014 • 

00700 

• 

00700 

0015 • 

00700 

• c 

00700 

• c 

00700 

• c 

00700 

• c 

o-TOC 

• c 

U0100 

• c 

00700 

• c 

00700 

• c 

00700 

0016 

00800 

0017 • 

00800 

0018 • 


subroutine inoata 
incluce ' oebug. ccm 

COMMON / OEBUG/ t ENT EH . ; OEBUG 

USER CONTROLLED PARAMETERS TO VARY OEBUG PRINT LEVEL 

I NTER if 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
IDEBuG 0-10. HIGHER NUMBER MEANS MORE PRINT 


INCLUDE 'CONTRL.COM' 

COMMON /CONTRL/ MOP. TINT 

real*b tint 

PROGRAM CONTROL DESCRIPTORS FOR MULTIPLE RUNS 

MOP MODE OF OPERATION 

1 » PREFLIGHT SIMULATION 

2 * POSTFLIGHT SIMULATION 

3 . MONTE CARLO SIMULATION 

TINT NUMBER OF SECONDS OF FULL OPERATION PER CYCLE 

Include 'envir.ccm 

common /envir/ ST at E ( 1 0 ) . prof 1 le ( 10 ,4 ) , ini t 
RE AL*B STATE. PROFI le 

REAL WORLD STATE PARAMETERS 

STATE STATE VALUES; X . Y , Z . XD . YO . ZD. EO . E 1 . E2 . E3 

PROFILE ATTITUDE PROFILE-TIME (SEC) VS 

INERTIAL ANGULAR RATES (RAD/SEC) 
init integration initialization key (-1) 


INCLUDE 'GFPART.COM' 

COMMON/G FPART / F A ( 4 . 4 ) ,EA( 4.12) ,FN(6.6) 

RE AL*8 FA.EA.FN 

MEASUR MENT AND STATE PARTIALS 

f a ATTITUDE STATE PARTIALS 

EA * CONSIDERED PARAMETERS PARTIALS 

C N • STATE PARTIALS 


COMMON /NOISE/ BwO ( 3) . SWD( 3 I ,BSF(3),SSF(3). BO (3) . SD( 3) 
,B00(3) .SDD( 3) .SRM.BRE.SRE 
REAL*8 BWO. SWO . BSF . SSF , BD , SO , BOO . SDO .SRM.BRE.SRE 


REAL WORLD GYRO MEASUREMENT URDUS 


BWO SWD 
BSF SSF 

eo so 

BDD SOD 


GYRO DRIFT ( RAD / SEC) 

GYRO SCALE FACTOR 

GYRO NONORTHOGONALITY (RAD) 

GYRO RELATIVE ORIENTATION (RAD) 


INCLUDE 'TARGETS. COM- 
COMMON /TARGETS/ MTYPE, 
LOGICAL JFLAG 


is.ns.jflag.kcooe.pi.tpi 


p«o* a 


INDATA 
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ooeoo 

ooio 

• 


REAL'S Pl.TPl 


00800 


• 

C 



00800 


• 

c 

MEASOR KENT 

SPECIFICATIONS 

00800 


• 

c 



OC GOO 


• 

c 

NT y PE 

measurement type 

0C800 


• 

c 

JF LAG 

SET FOR STAR OBSTRUCTION 

00800 


• 

c 

NCOOE 

- * MEASUREMENT PROCESSING 

00800 


• 

c 

PI 

PI 

00800 


• 

c 

TPl 

2'P: 

00800 


• 

c 



00800 

C020 



INCLUDE ' AST AT E . CON ' 


00900 


« 

c 



00900 

0021 

• 


COMMON /ASTATE/ OE ( 4 ) . E( 4 ) . wD( 3 ) , SF ( 3 ) , 0< 3) . CD( 3 ) 

00900 

0022 

• 


REAL'S DE.E.MD.SF.D.DO 

00900 


• 

c 



00900 


• 

c 

ATTITUOE STATE AnO CONSIDERED PARANETERS 

00900 


* 

c 



00900 


• 

c 

0 

DIFERENTIAL of quaternions 

00900 


• 

c 

E 

Ol'ATERNIOMS 

00900 


• 

c 

WO 

GYRO DRIFT RATE < RAD/SEC ) 

00900 


• 

c 

SF 

GYRO SCALE factor 

0090C 


• 

c 

0 

gyro non-ortmoganali ty (rad> 

00900 


• 

c 

00 

GYRO RELATIVE ORIENTATION (RAO) 

00900 


• 

c 



00900 

0023 



INCLUOE 'FILTER. CON' 


OlOOO 

0024 



COMMON/ F I LTER/ IPN< 6 ) 

,1PA(16) IIPN NAS I PN( 11) JACK 

01000 


• 

c 



01000 


• 

c 

filter oat* 

constants 

01000 


• 

c 



01000 


• 

c 

1 PN 

array InOEX of estimated pos parameters 

01000 


* 

c 

I PA 

* * • ATT PARAMETERS 

01000 


• 

c 



01000 

0025 



INCLUOE 'SEQU.COM' 


01100 

0026 

• 


CONMON /SEQU/ ! S<25> 

. ITSI4.5) . 1 AA(3.4),IFLAG 

01100 


• 


. .DTST.OTGPS. IOELAy(II) 

01100 

0027 

• 


REAL'S OTST.OTGPS 


01100 

0026 

• 


LOGICAL IFLAG 


01100 


• 

c 



01 100 


• 

c 

SEQUENCE OF 

EVENTS tables 

01100 


• 

c 



01100 


• 

c 

I S 

event schedulaR 

01100 


• 

c 

ITS 

cycle sequencer 

01 100 


• 

c 

I A A 

alternate actions 

01 100 


• 

c 

IFLAG 

set WHEN TARGET IS OBSTRUCTED 

01100 


• 

c 



01100 

0029 



INCLUDE 'TNaT.CON' 


01200 

0030 

• 


COMMON / TMAT / A(3.3|, 

B(3.3).C(3,3),EM(4,3) 

01200 

0031 

• 


REAL'S A.8.C.EM 


01200 


• 

c 



01200 


• 

c 

TRANSFORMATION matrices 

01200 


• 

c 



01200 


• 

c 

A 

INERTIAL to boot axes 

01200 


• 

c 

s 

gyro to boot axes 

01200 


• 

c 

c 

GTRO NON- ORTHOGONAL TO GTRO AXES 

01200 


• 

c 

EM 

BOOT TO QUATERNIAN AXES 

01200 


• 

c 



01200 

0032 



INCLUDE ' NSTATE.COM' 



VAX-11 FORTRAN V2.0-2 
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INDATA 


01300 



C 

01300 

0033 



01300 

0034 



01300 



c 

01300 



c 

01300 



c 

01300 



c 

01300 



c 

01300 



C 

01300 



c 

01300 



c 

01300 

01300 

0035 


c 

01400 



c 

01400 

01400 

0030 



01400 

0037 



01400 



c 

01400 



C 

01400 



c 

01400 



c 

01400 



c 

01400 



c 

01400 

01400 

0030 


c 

ooioo 



c 

00200 

00300 

0039 



00400 

00500 

0040 



00600 



c 

00700 



c 

00800 



c 

00900 



c 

l' 1 000 



c 

01100 



c 

01200 



c 

01300 



c 

01400 



c 

01500 



c 

01600 



c 

01700 



c 

01800 



c 

01900 



c 

02000 



c 

02100 



c 

02200 



c 

02300 



c 

02400 



c 

02500 



c 

02600 

01500 

0041 


c 

01600 

0042 



01600 

0043 



91600 



c 

01600 



c 

01600 



c 
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COMMON /NSTATE/ * D ( 6 ) . * ( 6 ) , RAOM , RADE 
REAL'S XD.X.RADM, RADE 

POSITION STATE ANO CONSIDERED PARAMETERS 

*0 state DERIVATIVES { km/sec AND KLl/SEC/SEC) 

X STATE POSITION PARAMETERS (KM AND KM/SEC) 

RAOM RADIUS OF THE MOON (KM) 

RADE EARTH DETECTABLE RADIUS (KM) 


INCLUOE 'ARRAVS.COM' 

COMMON /ARRAYS/ T 1 < 3 ) . T2 ( 3 ) . T3( 3 ) . T4< 1 0 ) . T 1 1 ( 3 . 3 > . T33< 3 . 3 ) 

. .T44< A. A) ,T66<6.6) . T77( 6 . 6) . T5( 4 ) , T 6< 4) ,T7(4) 

REAL'S T1 .T2.T3.T4. T 1 I . T33 , T44, T 66, T77.T5.T6.T7 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BV ALL MODULES 

T 1 — T 4 SINGLE OIMENSION ARRAYS 

Til - T77 DUAL DIMENSIONED ARRAYS 
Til DUAL ARRAY; OFF 01 AGIONA L SET TO ZERO 

INCLUOE 'TIME.COM' 

COMMON /TIME/ T I«E . TNEXT . T STOP . T I A . DEL . T IN, DTN .DAT EO . TZERO 
• , TME AS. TRACK, T IS. TISN.DT A. DAT ER. TPRINT, DTPRINT 

REAL'S T 1ME. TNEXT. TSTOP. T I A.OEL. TIN.DTN.DATEO, TMEAS. TRACK. T IS. 

. T ISN.DT A. TZERO. OA TER, TPRINT, OTPR I *T 

THESE ARE THE TIME REFERENCE FRAMES 

TIME ATOMIC TIME SINCE INITIALIZATION (SEC) 

TNEXT TIME FOR NEXT POSITION INTEGRATION (SEC) 

TSTOP RUN TERMINATION TIME (SEC) 

TIA ATTITUDE INTEGRATION TIME (SEC) 

0 L * ' STEP SIZE < SEC) 

TIN POSITION INTEGRATION TIME ( SEC I 

D™ * * STEP SIZE (SEC) 

OATEC DATE OF FLIGHT EPOCH ( JD) 

OATER DATE OF 1950 EPOCH ( JD ) 

TZERO START TIME IN SECS. SINCE OATEO 

TSLEK TIME NEEOEO TO SLEM AND ACQUIRE (SEC) 

TIS PEAL KORLO REFERENCE TIME (SEC) 

TISN TIME FOR NEXT RM POSITION INTEGRATION (SEC) 

DTA USUALLY ♦ DEL BUT ♦ TSLEW - TIA MHEN OEL 

TOO LARGE AT measurement TIME 
TPRINT TIME FOR PRINT (SEC) 

DTPRInT INCREMENT ON TPRINT (SEC) 

INCLUDE 'CONST. COM- 

COMMON /CONST/ ATM, R BM . R D$ , RBO , R E3 , M3 . UM , US , UE , J2 , J3. 04 , DTU < PK1 
REAL'S A TM. fi BM. ABE. RB0.REa,RM2. UM.US.UE.Ja. J3. J4 . DTU , PK 1 

PROGRAM CONSTANTS 


P*0* 3 


INDATA 
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Pag* < 




1 0 — Apr — 1 961 
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06:56:10 

06:51:31 


01600 



C 


ATM 

S/C AREA TO MASS RATIO (METEPS/KG) 

01600 



C 


RBM 

OBSTRUCTION RADIUS OF THE MOON (KM) 

01600 



C 


R8E 

* * EARTH (KM) 

01600 



C 


9 BO 

‘ * SUN (KM) 

01600 



C 


R 2 

SQUARE OF THE EARTHS RADIUS (KM 2) 

01600 



C 


RM2 

» LUNAR RADIUS ( KM 2 ) 

01600 



C 


UM 

LUNAR GRAVITATION CONSTANT (KM 3/SEC 2) 

01600 



C 


US 

SOLAR 

01600 



c 


U . 

EARTH 

01600 



c 


U2.U3.J4 

zonal gravitational harmonic terms 

01600 



c 


DTU 

REGULARIZED TIME STEP SIZE (SEC) 

01600 



c 


PK1 

SOLAR PRESSURE CONSTANT 

01600 



c 




01600 

0044 



INCLUDE 

•UPOT.COM' 


01700 



c 




01700 

0045 



C1MMON 

/UPOT/ QN(6) , QA< 16) ,0(6 .6 ) ,QDOT (6,6) 

01700 

0046 



REAL'S 

QN.QA.O .QCOT 


01700 



c 




01700 



c 


STATE STIMATION PARAMETERS 

01700 



c 




01700 



c 


ON 

NAV. DVN . NOISE COVARIANCE DIAGONAL 

01700 



c 


QA 

MIN. VALUES FOR ATT. COVARIANCE DIAGONAL 

01700 



c 


0 

CONTRIBUTION TO NAV. COV . FOR DYN, NOISE 

01700 



c 


000 T 

DIFFERENTIAL OF 0 

01700 



c 




017C0 

0047 



INCLUDE 

'PLOT.COM 1 


01800 



c 




01800 

0048 



COMMON 

/PLOT/ TP 1.TP2 


01800 

0049 



REAL'S 

T P 1 ,TP2 


01800 



c 




01800 



c 


PLOTING INFORMATION 

01800 



c 




01800 



c 


T P 1 

LOWER ABSCISSA VALUE - TIME (MIN) 

01800 



c 


TP2 

UPPER * • * 

01800 



c 




01800 

0050 



INCLUDE 

1 PHIA.COM' 


00100 

0051 



COMMON 

/PHI A/ PA (4, 4 ) , TA(4 , 12) . PDA (4, 1 6) ,PHI Al 16, 1 6) , 

00200 





COVA ( 16.16), POA ( 16,16) ,QMAX 

00300 

0052 



REAL'S 

P A , TA , PDA . PH I A . COVA , POA , QMAX 

00400 



c 




00500 



c 


THESE ARE THE 

ATTITUDE TRANSITION AND COVARIANCE MATRICES 

00600 



c 




00700 



c 


PA 

ATTITUDE STATE TRANSITION MATRIX 

00800 



c 


TA 

■ PARAMETER TRANSITION MATRIX 

00900 



c 


PDA 

DERIVATIVE OF TRANSITION MATRICES 

01000 



c 


PHI A 

* AGGREGATE TRANSIT ION MATRIX 

01100 



c 


COVA 

“ NEW COVARIANCE MATRIX 

01200 



c 


POA 

" PREVIOUS COVARIANCE MATRIX 

01300 



c 


QMAX 

" COVARIANCE NORM MAX 

01400 



c 




01900 

0053 



INCLUDE * PHIN . COM * 


02000 

0054 



COMMON 

/PHIN/ PN( 6, 6 ) ■ 

PDN( 6.6) . PHIN(6 , 6) ,COVN( 6 ,6) , 

02000 




, 

PON{ 6,6) 


02000 

0055 



REAL'8 

PN.PON. PHIN, COVN, PON 

02000 



c 




02000 



c 


THESE ARE THE 

NAVIGATION TRANSITION AND COVARIANCE ARRAYS 

02000 



c 





Pag* 5 


INOAT A 
02000 


* C 

02000 


• C 

02000 


• C 

02000 


• C 

02000 


* C 

02000 


• C 

02000 

0056 


02100 

0057 

♦ 

02100 

0058 

• 

02100 

0059 


02200 

0060 

• 

02200 


* 

02200 

0061 

• 

02200 


• c 

02200 


♦ c 

02200 


• c 

02200 


• c 

02200 


• c 

02200 


* c 

02200 


• c 

02200 


• c 

02200 


* c 

02200 


* c 

022CO 


• c 

02200 


• c 

02200 


• c 

02200 


• c 

02200 


• c 

02200 

0067 


02300 

0063 

* 

02300 


* 

02300 

0054 

* 

02300 


« c 

02300 


* c 

02300 


* c 

023C0 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 

0065 


00100 

0066 

• 

00200 


• 

00300 

0067 

* 

00400 


• 

00500 


• c 

00600 


« c 

00700 


* c 

00800 


• c 

00900 


• c 

01000 


• c 

01100 


« c 

01200 


• c 
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PN 

POSITION 

STATE TRANSITION MATRIX 

PON 

M 

DERIVATIVE OF TRANSIT 1 ON MATRIX 

PH IN 

N 

AGGREGATE TRANSITION MATRIX 

COVN 

N 

NEW COVARIANCE MATRIX 

PON 

" 

PREVIOUS COVARIANCE MATRIX 


INCLUDE 1 GCPDA T . COM 1 

COMMON /GCPOAT/ 1 GCPOT ( 4 . 1 0 ) . L INNUM, TGCP ■ I DLMAX , GCPN , DT PS 
REAL*0 TGCP. GCPN. OTPS 
INCLUDE 'STARPAR.COM' 

COMMON /STARPAR/ BS I 2 , 2 ) , SS l 2 . 2 ) , TNS ( 3 , 3 , 2 ) . TBNS ( 3 , 3 . 2 ) . 

. BSK( 2,2) . S = K(2 . 2 ) . TNSK( 3,3,2) 

REAL»B BS . SS , TNS . T BNS , BSK . SSK , TNSK 


STAR TRACKER PARAMETERS 

IN EACH CASE THE LAST SUBSCRIPT REFERS TO THE 
TRACKER USED 

BS = BIAS - ACTUAL (RAD) 

SS * NOISE STANOARO DEVIATION - ACTUAL (RAD) 

TNS = MISALIGNMENT ARRAY - TRANSFORMATION FROM 

STAR TRACKER TO NOMINAL 

TBNS * ORIENTATION ARRAY - TRANSFORMATION FROM 
NOMINAL TO BODY 

BSK = BIAS - KNOWLEDGE (RAD) 

SSK * NOISE STANDARD DEVIATION -KNOWLEDGE (RAD) 

TNSK * MISALIGNMENT KNOWLEDGE ARRAY - TRANSFORMATION 
FROM STAR TRACKER TO NOMINAL 


INCLUDE ' COMPC SIT. COM ' 

COMMON /COMPOSIT/ PH 1 ( 22 , 22 ) . QT ( 22 . 22 ) ,COV ( 22 . 22 ) , P0( 22 . 22 ) . 

I P ( 2 2 ) ,XT( 22 1 .P< 22,221 
REAL*8 PHI.QT.COV.PO.XT, P 


PH* 

QT 

COV 

PO 

IP 

XT 

F 


COMPOSIT STATE TRANSITION MATRIX 
“ PROCESS NOISE ARRAY 

NEWEST COVARIANCE ARRAY 
OLD COVARIANCE ARRAY 

ARRAY OF FLAGS INDICATING ESTIMATED AND 
CONSIDERED PARAMETERS 
COMPOSIT ESTIMATED PLUS CONSIDERED 
STATE VECTOR 

INITIALIZED TRANSITION MATRIX FOR NEXT 
INTREVAL 


INCLUDE 'LMTPAR.COM' 

COMMON /LMTPAR/ A L . LON , L AT , TBN L ( 3 . 3 ) . TNL ( 3 , 3 ) • BL ( 2 ) . SL ( 2 ) , 
. BKL( 2) , SK L ( 2 ) ,TNLK(3,3) ,TIE0(3,3) . S IGGCP , THET 

REAL*0 AL.TBNL.TNL .BL.SL , BKL , SKL , TNLK , T I EO ,S IGGCP, LAT , LON, 
. THET 


LANDMARK TRACKER PARAMETERS 

AL = ALTITUDE OF LANDMARK (KM) 

LON * LONGITUDE OF LANDMARK (DEG) 

LAT * LATITUDE OF LANDMARK (DEG) 

TBNL * ORIENTATION ARRAY FOR LANDMARK TRACKER 
NOMINAL TO BODY 


[soar a 


01300 
01400 
0 1 SCO 
01600 
01700 
01000 
Cl 900 
02000 
02100 
02200 
02300 
02400 
02600 


TNL 

BL 

SL 

BKl 

ThET 

Skl 

T1E0 

TNLK 


02400 

0068 



INCLUDE 'MEASOuT 

C0100 

0069 



COMMON /MEASGl. 

0C200 




RS( 2 ,2 

0:300 




. EDMS (2 

00400 

0070 



REAL*8 MX. RGPS 

00500 




EDHS . . 

0C600 



C 


OC700 



c 


00600 



c 

.MEASUREMENT OU 

0:300 



c 

MX 

010UO 



c 


01100 



c 

EMXG 

01700 



C 


O' 300 



c 

RGPS 

01400 



c 


OISOO 



c 

OHCS 

01600 



c 


01700 



c 

DVCS 

01600 



c 


01900 



c 

EDMS 

02000 



c 


02100 



c 

EDVS 

02200 



c 


02300 



C 

MS 

02400 



c 


02500 



c 

RS 

02600 



C 


02700 



c 

DHCL 

J2800 



c 


02900 



c 

OVCL 

03000 



c 


03100 



c 

EDHL 

03200 



c 


03300 



c 

edvl 

03400 



c 


03500 



c 

LMU 

03600 



c 

RL 

03700 



c 


03800 



c 


02500 

0071 



INCLUDE 'GPSPAR 

02600 

0072 



COMMON /GPSPA 

02600 




VSK( 3 

02600 

0073 



REAL'S PB.VB. 

02600 



c 



10" Apr- 1 981 0656110 
10-*pr-1981 06:51:31 

= MISALIGNMENT ARRAY - ACTUAL 
TRACKER TO NOMINAL 

* BIAS - A'.'-tL (RAD) 

= '.CiSE STANDARD DEVIATION - ACTUAL (RAD) 

= BIAS - knOhlEOGE (RAO) 

= LCOK ANGlE 'RAD) 

* NC.SE STANDARD DEVIATION -KNOWLEDGE (RAD) 

= INITIAL EA-’H FIXED TO INERTIAL 

TRANSFORMATION 

, MISALIGNMENT ARRAY KNOWLEDGE 
TRACKER TO NOMINAL 
S I GO C P * POSITION UNCERTAINTY DUE TO CLOUDS 


V f ■ 6 j . RGPS ( 6 , 6 ) ,DHCS( 2) ,D VCSf 2 > ,MS( 3, 2) 
, ... . DVCL , LVU ( 3 ) . RL ( 2 . 2 ) , EMXG( 6 ) , 

EGVSI2I . EDHL.EDVL 

-C i> .DVCS . VS . R5 , DHCL , DVCL , LMU.RL , EMXC, 
S.EDmL.EOVL 


>UT PARAMETERS 

* EOS I T I ON/VE „OCITV STATE MEASUREMENT - GRS 

f MM.KV/SCC) 

. ESTIMATED egsition/velocity state 
MEASUREMENT - HOPS 

I STATE measurement noise covariance 

I KNG« L EDGE ! - GPS ( KM* • 2 . KM/SEC • *2 ) 

. STAR MEASUREMENT HORIZONTAL DEVIATION 
F3GW BORESIGHT - START (PAD) 

. STAR MEASUREMENT VERTICAL DEVIATION 
FECIM BORESIGHT - START (RAD) 

« ESTIMATED S t AR MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT IPAD) 
x ESTIVATED STAR MEASUREMENT VER t ICAl 
DE.IA’ION FROV- BORESIGHT I SAD ) 

* STAR MEASUREMENT UNIT VECTOR ( SECOND 

SUBSCRIPT REFERS TO TRACKED) - START 
« STAR MEASUREMENT NOISE COVARIANCE 
(K.NO«lEDGE) - START (RAD**2) 

> LANDMARK MEASUREMENT HORIZONTAL DEVIATION 
F PCM 50RC51GHT - LAMKT (RAD) 

» LANDMARK MEASUREMENT VERTICAL DEVIATION 
FROM BORESIGHT - LAMKT ( RAD) 

X ESTIMATED LANDMARK MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RADI 
« estimated landmark measurement VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 

= LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

* landmark measurement noise covariance 

(KNOWLEDGE) - LAMKT ( RAO • *2 ) 
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02600 



r 

CPS PARAMETERS 

02600 



C 

PB = POSITION BIAS - ACTUAL 

02600 



c 

VB = VELOCITY BIAS - ACTUAL 

02600 



c 

PS * POSITION NOISE STANDARD DEVIATION - ACTUAL 

02600 



c 

VS * VELOCITY NOISE STANDARD DEVIATION “ ACTUAL 

02600 



c 

PBK * POSITION BIAS - KNOWLEDGE 

02600 



c 

VBA * VELOCITY bias - KNOWLEDGE 

02600 



c 

PSK * POSITION NOISE STANOARD DEVIATION - 

02600 



c 

KNOWLEDGE 

02600 



c 

VSK = VEuDSITY noise standard deviation - 

02600 



c 

knowledge 

02600 



c 


02600 

0074 



INCLUDE 'PART.CCV 

02700 

0075 



COMMON /PART/ PAi22i.PY(22),PZ(22).PXD(22).PYD(22),PZD'22). 

02700 




. PDHS122.2) , PDYS ( 22 1 2 ) . POHL ( 221 , PDV L ( 22 ) 

02700 

0076 



REAL'S PX.PY .FZ.PXD.PTD.PZD.PDHS.PDVS.PDHL.PDVL 

02700 



c 


02700 



c 

PARTIALS OF THE RESPECTIVE MEASUREMENTS MADE 

02700 



c 


02700 



c 

FOR GPS 

02700 



c 

p* * PARTIALS OF X POSITION MEASUREMENT 

02700 



c 

py . • • r 

02700 



c 

PZ * • • z 

02700 



c 

PAD = « X VELOCITY 

02700 



c 

P YD * * * Y 

02700 



c 

PZO * * * Z 

02700 



c 

FOR STAR TRACKER K iK IS THE SECONO PARAMETER) 

02700 



c 

PDHS * PARTIALS OF HORIZONTAL DIFLECTION 

02700 



c 

PDVS * * * vertical 

02700 



c 

FOR lanomark tracker 

02700 



c 

PDHl * PARTIALS OF horizontal diflection 

02700 



c 

PDV L * ■ ‘ VERTICAL 

02700 



c 


02700 

0077 



INCLUDE 'CLOUD.COM 

00100 

0078 



COMMON /CLOUD/ C LOT 9 L 1 12) 

00200 

0079 



REAL'S CLOTBL 

00300 



c 

PCNT THE PERCENTAGE OF CLOUD COVER 

00400 



c 


02800 

0080 



INCLUDE •TITL-.COM' 

00 = 00 

0081 



COMMON /TITLE/ AUTLE!«0) 

00200 

0082 



LOGICAL'1 ATIllE 

00300 



c 


0C400 



c 

ATITL IS the TITLE PRINTED AT EACH PRINT TIME 

00500 



c 

AS WELL AS THE top OF EACH PLOT 

0S6C0 



c 


02900 

0083 



INCLUDE ’IAOOE.COM' 

00100 

0084 



COMMON /MODE/ MODE HO) 

00200 



c 


00300 



r 

MODEM) * LANDMARK TPACKER SWEEP MODE 

00400 



c 

0 * RANDOM 

00500 



c 

1 * FIXED AT INPUT THET 

00600 



c 

2 * NO DEFAULT TO STAR TRACKER 

0070C 



c 

MODE ( 2 j « CLOUD SELECTION MODE 

00800 



c 

o « RANDOM CLOUD DENSITIES BASED 

00900 



c 

ON INPUT TABLES CLOTBL 

01000 



c 

1 « FIXED DENSITY AT NO CLOUDS 

01100 



c 

2 . NO CLOUDS MITH 100% CLOUD 


P*9» f 


INDATA 


01200 


• c 

01300 


• c 

01400 


• c 

01500 


• c 

03000 

0085 


03100 

0088 


03200 


c 

03300 


c 

03400 

0087 


03500 



03600 


c 

03700 


c 

03800 


c 

07900 


c 

04000 

0068 


04100 

0089 


04200 

0090 

4 

04300 

0091 


04400 

0092 


04500 

0093 


04600 

0094 


04700 

0095 


04800 

0096 


04900 

0097 


05000 

0098 


05100 

0099 


05200 

0100 


05300 

0101 


05400 

0102 


05500 

0103 


05600 

0104 


05700 

0105 


05800 

0106 


05900 

0107 


06000 

0108 


06100 

0109 


06200 

01 1 0 


06300 

01 1 1 


06400 

0112 


06500 

01 13 


06600 

0114 


06700 

01 IS 


06800 

0116 


06900 

0117 


07000 

0118 


07100 

0119 


07200 

0120 


07300 

0121 


07400 

0122 


07500 

0123 


07600 

0124 


07700 

0125 


07800 

0126 


07900 

0127 


08000 

0128 


08100 

0129 


08200 

0130 



10-App-igai 06:56:10 
1 0 -Apr- 1 901 06:51:31 


v.u»r « run a SKfcC I F I ED 


PERIOD ( CLOTBL ( 1 i toil 
MODE ( 3“ 1 0 ) NOT SPECIFIED AT PRESENT 


DIMENSION TP(4 ,3) . TPT(3.4) ,PTP(3 ,3) ,PO(4 4) TMPf 3 a. 1 
DIMENSION SDA( 16). S0N(6) ° ' * ' * ™ P < 3 * 4 > 

EQUIVALENCE (T 1 ( 1 ) , Pil ) . ( T 1 (2) , THE),(T1 (3) .PHI) 


RE A U*8 A1 ,A2.A3,A4,a5,A6,A7, A8 , C 1 ,C2 , C3S1 
SOA , TMP , TP . TPT , C3, SI 
TAPE5 ATTITUDE PLOT TAPE 

TAPE7 NAVIGATION PLOT TAPE 


S2,S3,TSTART,PQ,PTP, 


OPEN(UNI T=4,TYP .'OLD' ) 

READ) 4,4) ! ATI TLE< I ) , I»1 ,40) 
FORMAT (20X.40A1 ) 

READ(4,60)((A( I,J),I-1,3),J»1,3) 

READ(4,10)AL 

RE A0(4, 1 0 ) ATM 

READ(4,60M(B( I ,J>, 1 = 1 ,3) ,J*1 3) 
3EAD(4,60) ( 8D( I ),I = i ,3) 

RE AD ( 4 , 6 0 ) ( BDD ( I ) , I = 1 ,3) 
READ(4.45)(BKL(I),U1 ,j) 

REA0I4 ,45) ( BL ( i ) . 1= 1 .2) 

R£ AD( 4 , 1 OJBRE 


RE AO ( 4 , 4 5 ) ( ( BS ( I , J ) . 1 = 1,2) ,J*1,2) 
READ(4,45)((BSK( I , j ) ,1 = 1 , 2 ) , J* 1 ,2) 
REAO(4,60)(BSF ( I ) , 1= 1 ,3) 

READ|4,60)( BI40 ( I ) , 1 = 1 ,3) 
READ(4,60)((C(I,vJ),I = 1,3),J = 1,3) 

RE AO (4, 90) (CLOTBL(I) , 1 = 1 , 1 0) 

REA0(4,45)CL0TBL( 1 1 ),ClOTBL(12) 

RE AD ( 4 , 1 1 5 ) ( ( C 0 V ( I , j ) , I « 1 , 22 i j « i 22 ) 
REA0(4, 1 30)(COVA( I , I ) , 1=) , 16) 

RE AO 1 4 . 1 30 ) ( CO VN ( I , I ) , 1 = 1 , 6 ) 
REAO(4,60) (D( l ) , I = 1 , 3 ) 

REA0(4, 1 20 ) DA T EO 
RE AO ( 4 , 1 20 )DAT ER 
RE AD ( 4 , 6 0 ) ( OD ( I) , I = 1 ,3) 

REAO(4,70) (DE( I ) , 1 = { ,4) 

REA0(4, 1 0 ) DE L 

RE AQ( 4 . 1 0 ) DHC L 

REAO( 4 ,45) (DHC S( I ) , I = 1 ,2) 

RE AD( 4 , 1 0 ) DT A 
RE AO' 4 , 20 IDTGPS , DTN 
READ ( 4 , 1 OIDTPR (NT 
RFAD(4 ,20)DTPS ,OTST 
RE AO( 4,10) DTIJ 
READ ( 4 , 1 0 ) DVC L 
REA0(4.45) (DVCS( [ ) , I = 1 ,2) 

RE AD( 4 , 70 ) ( E ( I ) . 1 = 1 , 4) 


REA0(4,70) ((EA ( I , J) , 1=1 ,4) , J=1 . )2) 
PEAD(4,70)((FA(I,d),I=1,4),J.1,4) 
REA0(4,80)((FN(I.J). 1 = 1,6) ,J*1 ,6) 
READ(4, 140)ICOVDI 
REA0( 4, 2 00) I DEBUG, I ENTER 
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Pag* 8 


I 


- riir.i mi ■ 


P«0* 9 


inoata 


08300 
08400 
08500 
00600 
08700 
00800 
08900 
09000 
09100 
09200 
09300 
09400 
09500 
09600 
09700 
09800 
09900 
10000 
10100 
1 C200 
10300 
10400 
10500 
1 0600 
1 0700 
1 0800 
10900 
1 1 000 
11100 
1 '200 
11300 
1 1400 
1 1500 
11600 
1 1700 
1 1800 
1 1900 
12000 
12100 
1 2200 
1 2300 
1 2400 
1 2500 
12600 
12700 
12600 
12900 
1 3000 
13100 
1 3200 
1 3300 
1 3400 
1 3500 
1 3600 
13700 
1 3800 
13900 


10- Apr-1 981 06:56:10 VAX-11 FORTRAN V2.0-2 
1 0 -Apr- 1 98 1 06:51131 _DBA01 [0 1 1 R.GCP J INOATA. FOR : 63 


0131 

0132 

0133 

0134 

0135 

0136 

0137 

0138 

0139 

0140 

0141 

0142 

0143 
0 144 

0145 

0146 

0147 

0148 

0149 

0150 

0151 

0152 

0153 
0*54 

0155 

0156 

0157 

0158 

0159 

0160 
0161 
0162 

0163 

0164 

0165 

0166 

0167 

0168 

0169 

0170 
017 1 
0172 
0>73 

0174 

0175 

0176 

0177 
0170 
0179 
0190 
0181 
0182 

0183 

0184 

0185 

0186 
0187 


RE AD< 4. 1 66 HIDE LATH ) . i*1 . 1 1 ) 

R6A0I4.140) IDLMAX 

PE ACM 4 . 1 80 ) ( IE S( Ii . I - 1 .25) 

READ(4.210)IFLAQ 

RE AO ( 4 . 1 4C ) 1GCP 

BEAD) 4. 1 60 )( I IGCP0T1 I , J) , I»1 ,4) , d»1 ,10) 

RE AD< 4, 140|INI 1 

RE *01 4. i 95) ( 1R1 I ) . I - 1 .22/ 

RE AO l 4, 1 90)1 I PAI I ) . I = 1 . 16) 

readi 4. i 70) u p-<( : ) . ; *i .6; 

READ) 4 .140)15 

RE*DI4,l60)({JTS(I.J).i=1.A).0*1.5) 

RE AD) 4 . 1 20 ) J2 

PE ADi 4 . 1 20 ) J3 

REAOf 4 . 1 20 ) J4 

READ) 4 . 2 1 0 ) JF L AG 

READ) 4 , 1 0 ) LAT 

RE AO) 4 , 60 ) ( LV'J < I ) . I = 1 , 3 ) 

READ) 4 . 1 0 I LON 
RE AD! 4 . 1 40 jMCOD 

READ ) 4.165)1 NODE' I ) , 1*1 . 10) 

RE AD * 4 , 1 40 ) MOP 

READ)4.60M(MS1I.J).I = 1.3),J»1.2) 

R£AD<4. 1 40 ) MT IP 

Rf AO) 4. 80 )(WX( I j , ! = 1 ,6) 

RE AO) 4 . 1 15 ) ( I P < I .J) . 1 = 1 . 22 ) . J»1 .22) 
PE*D)4,70)MPA) l , J / , 1 = 1, 4), 0*1,4) 

READ) 4 . 60 ) ( P3( I) . I = 1 . 3) 

READ) 4,60) (PBK I [ I . ! = 1 .3) 
PEAD<4,70)flPDAi;.Jj.i=1,4),d»1.16) 

RE A0( 4 , 1 15 ) ( ROHLl I (. 1 = 1.22) 

BEA014.1 1 5 ) { < POhS' I . J ) . I = 1 , 22) ,J »1 ,2) 

PE *0 1 4 . 8 0 ) ( ( PON ( i. , ,1 = 1 . 6 ) , J= 1 .6) 

RE AD )4,1 15) ( PD I ) . 1 = 1.22) 
READ)4.115)((PJ>Sii,J). 1=1. 22). J*1.2) 

PE AO l 4 , 1 1 5 ) ( f P HI I I , J > , I * 1 , 22 ) , J* 1 « 22 ) 
BEADI4.1 1 0 ) ( )PH[A( i . J ) , I = 1 , 16).<J»1,16) 
PE A 51 4 . 8 0 ) f f PH I NI I . J ) , 1 * 1 . 6) , ii* 1 .6) 

P£ AO ) 4 , 1 0 ) P I 
RE ADi 4 , 1 20 )PK 1 

PE ADI 4, 80 M ( P8 • I . j ; . I = 1 .6) ,d = 1 ,6 ) 
REA0i4,l15)(IPj':. J i.:«1.22),J«1.22) 
REAu'4.1 10 ) I I PDA' I. j).i = 1 . 1 6 ) , J = 1 , 16) 
PE*£)(4.80)MP0M I . j l . 1 = 1 .6) ,J«1 .6) 

RE AD< 4 . 90 ) ( ( PROFILE ' I . J) , I «1 ,10) ,J»1 ,4) 
RE ADi 4.60 M PS{ I 1.1 = 1 .3) 

READ) 4 . 60 } ( PSK ( I I . i = 1 . 3) 

REAOI 4 . 1 15) ( PX < I / . I = • .22 J 
RE AO 1 4 , 1 15 I ( PT ( I ) . I = 1 . 22 ) 

RE A0(4 . 1 15) ( PZ ( I ) . I = 1 .22) 

R£A0(4. 1 1 5 ) < PXDf I). I = ' .22) 

PE A0(4 . 1 15)( PTDI I i . I =1 .22) 

PEAD<4, 1 1 5 ) ( PZ 0 ( I i . I =1 .22) 
REAO(4.eO)((Q(I.di.:=1.6),d«1,6) 

R£ A0( 4. 1 10 ) f OA ( I ) . I = 1 . 16) 

RE AO ( 4 , 8 0 ) ( ( ODGT ( I . J ) . I • 1 , 6 ) ,«J» 1 , 6) 
REAOI 4 , 1 Q)QMAX 


r- 


INOAT A 


14000 

0188 

14100 

0189 

14200 

0190 

14300 

0191 

14400 

0192 

14500 

0193 

14600 

0194 

14700 

0195 

14800 

0196 

14900 

0197 

15000 

0198 

15100 

0199 

15200 

0200 

15300 

0201 

15400 

0202 

15500 

0203 

15600 

0204 

15700 

0205 

15800 

0206 

15900 

0207 

16000 

0208 

16100 

0209 

16200 

0210 

16300 

021 1 

'6400 

0212 

16500 

0213 

16600 

0214 

16700 

0215 

16800 

0216 

1 0900 

0217 

17000 

0218 

17100 

02 1 9 

17200 

7220 

17300 

0221 

17400 

0222 

17500 

0223 

17600 

0224 

17700 

0225 

1 7800 

0226 

1 7900 

0227 

18000 

07?o 

18100 

0229 

18200 

0230 

18300 

0231 

18400 

02 J2 

18500 

0233 

18600 

0234 

10700 

0235 

18800 

0236 

18900 

0237 

19000 

0238 

19100 

0239 

19200 

0240 

19300 

0241 

19400 

0242 

19500 

0243 

19600 

0244 
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RE ADi 4 ,80 I <<JN( I ) . I = 1 ,6) 

READ(4. 1 15) ( <QT ( I . J I . 1 = 1 .22) ,d*1 .22) 
READ(4,40)RADE .RA0M.R8E.RBM 
RE AD ( 4 , 1 OIRBO 
RE AD ( 4 , 1 20 |R£2 

RE AD (4. 8 0 M ( RG°S( I , J I . 1 = 1 , 6) ,d*1 ,6) 
REA0(4.70)l<RUI.J>.I = l.2),J»1,2) 

RE AD (4,1 20 ) RM2 

RE AD I 4.45 M ( (RSI I . J.K, .1 = 1 ,2),J«1 ,2),K*1 ,2) 

RE AD ( 4 , 6 0 ) ( SO ( I ) .1=1 ,3l 
RE AD 14.60) ( SDD ( I).I = 1.3) 

READ|4.60)(SF( 11.1=1,3) 

RE AD ( 4 . 1 01SIGGCP 
RE AD(4, 45) ( SKL ( I 1 . 1 = 1 .2) 

READ(4.45)(SL( 11,1=1 ,2) 

RE AD ; 4 . 1 01SRE 
READ(4.60)(SSF( 11.1=1.3) 

READ! 4. 70) ( (SS ( I . J) , I = 1 .2) . J = 1 .2 ) 

REAOI 4. 70 )( (SSK( I , J ) . 1 = 1 ,2 ) , J*1 , 2) 
READ(4.80)(STAT (11.1=1.101 
REA0(4,60MSWD( 11,1 = 1.3) 

READ(4.60)( ( T b Nl I I .J 1 . 1 = 1 . 3) ,J=1 ,3) 
READ(4.60)(( ( T GNS ( I , J , K ) , 1=1 ,3) , d - 1 , 3 ) , K*1 .2) 
READ ( 4 , 101TMET 

READ(4,60) ( (TI E0( I .0 ) , i = 1 , 3) , 0=1 .3.' 
READ(4»60)((TNL( 1,0) . 1=1 ,3), 0=1 ,3) 

RE ADI 4, 60) ( ( TNLK< I .0 1 . i = 1 . 3) .0=1 ,3) 

READ! 4', 60) ( ( ( TNS( I . J ,K) , 1 = 1 ,3) ,0*1 ,3) ,K«1 ,2) 
RE ADI 4 .60) ( ( ( TNSKI I . 0 . K ) , I = 1 , 3 ) . 0« 1 , 3) , K- 1 , 2 ) 
M =0(4.60) ( T1 ( I ) . 1 = 1 . 3) 

REA0(4 . 60)((T1 1(1. J) ,1 = 1 .3), 0=1. 3) 
REA0(4,60)(T2< I ) , [ = 1 ,3) 

READ(4 . 60) ( T3( I| . I = 1 ,3) 

RE ADI 4,60) ( ( T33( I .0) , I = 1 ,3 ) ,0-1 ,3) 

READ) 4 , 90 ) ( T4 ( I ) . I = 1 ,10) 

RE A0< 4, 70) ( (T44( I ,0) , 1 = 1 ,4 > ,0*1 ,4) 
READ(4.70)(T5( I). 1 = 1 ,4) 

READ(4,70)(T6( I), 1 = 1 ,4) 

READ(4.80)( (T66( I .0) . 1=1 .6) ,0*1 .6) 

READ(4. 70) (T7( I ) . I = 1 ,4 ) 

READ(4.80) ( (T77( I .0) . 1 = 1 .6) ,0*1 ,6) 

RE ADI 4. 7C) ( ( TA( I .0) . 1 = 1 ,4) ,0*1 , 12) 

RE A0( 4 , 3 0 ) T I A , TIME. TIN 

READ! 4. 40 HINT . T IS . T I SN . TMEAS 

RE AO ( 4 , 1 0 ) TNEX T 

RE AO ( 4 , 3 0 ) T PI . TP2.TPI 

READ! 4. 1 0 )TPRI NT 

RE AD( 4 , 1 OtTSTOP 

READ(4. 1 OtTZERO 

RE A0( 4 . 1 20)UE 

RE A0( 4 , 1 20 )UM 

RE AD( 4 . 1 20 ) US 

RE AU( 4 , 6 0 ) { VB( I ) , 1 = 1 .3) 

READI4.60) (VBK( I ) . 1=1 .3) 

RE A0( 4 , 60 ) ( VS( I ) . 1 = 1 .3) 

REAO(4,60)( VSK ( I), 1=1 .3) 

RE AD( 4 , 6 0 ) ( WD( I), 1*1 ,3) 
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19700 

0245 


READ(4, 1 15>(XT < I ) . 1.1 .22) 




1 9600 

0246 


READ(4.80)(X( t ) ,1 = 1 .6) 




19900 

0247 


REA0) 4 , 80 ) ( XD( I » , I = 1 ,6) 




20000 


C 





20100 

0248 

1 c 

rr'PMAT ( 2 OX , F20 . 10) 




20200 

0249 

20 

FORMAT ( 2 OX ,F20 . 1 0 . / . 20X , F20 . 1 0 ) 




20300 

0250 

30 

FORMAT) 2 OX .F20 . 10. / . 20X , F2 0 . 1 0 , / , 20X . F20 . 1 0 ) 




20400 

0251 

40 

FORMAT (20X.F20 . t0,/.20X,F20.10,/,20X,F20.10. 

/ , 20X , F 20 . 

10) 


20500 

0252 

45 

FORMAT ) 2 OX , 2F 2 0 . 10) 




20600 

0253 

60 

FORMAT ( 20X , 3F2 0 . 10 ) 




20700 

0254 

70 

FORMAT! 20X.4F20. 10) 




20600 

3755 

80 

FORMAT ( 2 OX . 6F 2 0 . 10 ) 




20900 

0256 

90 

FORMAT (20X.10F20.10) 




21000 

0257 

100 

FORMAT < 2 OX , 1 1 F 20 . 1 0 ) 




21100 

0256 

1 1 0 

FORMAT ( 2 OX , 16F20. 10) 




21200 

0259 

1 1 5 

FORMAT ( 20X.22F20.10) 




21300 

0260 

120 

FORMA T ( 2 OX , E20 . 10) 




21400 

0261 

130 

FORMAT ( 20X .5E20. 10) 




21500 

0262 

140 

FORMAT) 20X. 110/ 




21600 

0263 

150 

F0RMAT(20X.3I1 0) 




21700 

0264 

160 

FORMAT) 20X, 41 1 0 ) 




2)800 

0265 

165 

FORMAT) 20X. 101 10) 




21900 

0266 

166 

FORMAT) 20X, 1 1110) 




22000 

0267 

170 

FORMAT ( 20X. 1 i 1 10) 




22100 

0268 

160 

FORMAT ) 20X , 121 10) 




22200 

0269 

190 

FORMAT) 20X, 161 10) 




22300 

0270 

195 

FORMAT ) 2 OX f 22 I 10) 




22400 

0271 

200 

FORMAT) 20X.I10 ,/.20X .110) 




22500 

0272 

21 0 

FORMAT) 20X.L7) 




22600 

0273 


RE HI NO 7 




22700 


C» 





22800 


c 

PSI « 361 . 




22900 


c» 





23000 

0274 


T1 ( 3 ) «36 1 . 1 

TEMPORARY 

FIX; 

JACK 

23100 

0275 


DO 400 I *1 ,16 1 

TEMPORARY 

FIX 


23200 

0276 

40 0 

soAuno. i 

TEMPORARY 

FIX 


23300 

0277 


00 450 1=1,6 1 

TEMPORARY 

FIX 


23400 

0279 

450 

SDN) I ) =0 . I 

TEMPORARY 

FIX 


23500 

0279 


00 500 1 « 1.6 




23600 

0260 


00 500 J * 1 ,6 




23700 

0261 

50 0 

Q< I , J) « 0 . 




23800 


c* • 



»*• • • 1 


23900 


c 

IF) PS I . E 0 - 361 . ) GO TO 1000 




24000 


o • • < 





24100 

0262 


I F ( T 1 ( 3 ) .EQ. 361.) GO TO 1000 1 

TEMPORARY 

FIX; 

JACK 

24200 

0283 


Cl « COS) T1 ( 1 ) ) 




24300 

0264 


SI * SIN ( T1 ( 1 ) ) 




244?0 

0285 


C2 • COS ( T 1 ( 2 ) ) 




24500 

0286 


S2 ■ SIN) T1(2) ) 




24600 

0287 


C3 • COS (Tit 3) ) 




24700 

0288 


S3 * S 1 M ) T 1 ( 3 » ) 




24800 

0289 


A 1 « SI • C2*C3 




24900 

0290 


A2 * Cl • S2 = S3 




25000 

0291 


A3 « Cl • S2*C3 




25100 

0292 


A4 ■ S 1 * C2*S3 




25200 

0293 


A5 - Cl »C2»S3 




25300 

0294 


Ab • S1*S2*C3 
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25400 

0295 


A 7 = Cl • C2 = C3 

25500 

0296 


A8 = SI • S2 = S3 

25600 

0297 


EM) * A 7 + A8 

25700 

0298 


E(2) * »5-A6 

25800 

0299 


E ( 3 ) * A 3+A4 

25900 

0300 


E( 4) * A 1 -A2 

26000 


C 


26100 

0301 

1000 

CONTINUE 

26200 

0302 


DO 1100 1=1,6 

26300 

0303 

1 1 00 

Q< I.I)=QNU) 

26400 

0304 


IF< ICOVOI .EO.O ) GO TO 8000 

26500 

0305 


00 2200 1=1,6 

26600 

0306 

22 00 

COV1 I . 1) =COVN( I . I ) 

26700 

0307 


00 3300 1= 1,16 

26800 

0308 

33 00 

COV( 1*6, I +6 ) *C OV A ( 1,1) 

269C0 

0309 


I F ( SON (1 ) . E 0- 0 . ) GO TO 250 0 

27000 

0310 


DO 2000 1=1,6 

27100 

0311 

20 00 

CO VN ( I . I ) = SDN1 I ) * • 2 

27200 

0312 


DO 2100 1=1.6 

27300 

0313 

21 00 

COV( 1,1) =C0VN( 1,1) 

27400 

0314 

2500 

I F ( SOA < 2 ) . EO . 0 . ) GO TO 8000 

27500 

0315 


DO 3000 1=1,16 

27600 

0316 

3000 

COVA ( I . I ) . SQA( I ) • • 2 

27700 

0317 


DO 3100 1*1,16 

27800 

0318 

31 00 

COV< 1+6, I +6 ) *C OV A( 1,1) 

27900 

0319 


DO 4000 1=1,3 

28000 

0320 


J * 1 + 1 

28100 

0321 

4000 

PTP( I , I) * SOA ( vJ ) •» 2 

28200 

0322 


TP< 1 , 1 ) = A2-A 1 

28300 

0323 


TP ( 2 . 1 ) = - A3- A 4 

28400 

0324 


TP< 3, 1 ) = A5-A6 

28500 

0325 


TP(4, 1 ) = A7+A8 

28600 

0326 


TP< 1 ,2) = A4-A3 

28700 

0327 


TP ( 2 . 2 ) *-A 1 -A 2 

28800 

0328 


T P ( 3 , 2 ) « A7-A8 

28900 

0329 


T P ( 4 , 2 ) *-A5-A6 

29000 

0330 


TP( 1 .3) = A6-A5 

29100 

0331 


T P ( 2 , 3 ) . A7 + A8 

29200 

0332 


T P ( 3 , 3 ) = A 1 - A 2 

29300 

0333 


T P ( 4 , 3 ) =-A3-A4 

28400 

0334 


00 5000 1*1,3 

29500 

0335 


DO 5000 J * 1 ,4 

29600 

0336 


TP(J.I) = . 5* T P ( J , I ) 

29700 

0337 

50 00 

TPT( I . J | » T P ( J , I ' 

29800 

0338 


CALL MAT AB1PTP , TP ,TMP,3,3. 

29900 

0339 


CALL MATABfTP, TMP,PQ,4.3.4) 

30000 

0340 


00 6000 1=1,4 

30100 

0341 


DO 6000 3=1 .4 

30200 

0342 

60 00 

COVA( I , J ) . PO (1,0) 

30300 

0343 


DO 7000 1=1,16 

30400 

0344 


DO 7000 J = 1 , 16 

30500 

0345 

70 00 

POA( I , J ) =COVA( I , J) 

30600 

0346 


00 7500 1*1,6 

30700 

0347 


00 7500 3=1,6 

30800 

0348 

75 00 

PONd.U; *COVN( 1.3) 

30900 

0349 

80 00 

WRITE(6, 9000) TSTART . TSTOP .1 

31000 

0350 


WRITE! 6. 10000) (COVA(I.I).I 
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I 



Pag* 13 


indata 


1 0- Apr- 1 98 1 06:56110 
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31100 

0351 

31200 

0352 

31300 


31400 


31600 


31600 

0353 

31700 

0354 

3 1800 

0355 

31900 

0356 

32000 

0357 

32100 

0358 

32200 


32300 

0359 

32400 

0360 

32500 


32600 

0361 

32700 

0362 

32800 

0363 

3i 300 

0364 

33000 


33100 

0365 

33200 

0366 

33300 

0367 

33400 

0368 

33S0L 


33600 


33’GO 


33800 


33900 


34000 

0369 

34100 

0370 

34200 

0371 

34 300 

0372 

34400 

0373 

34500 

0374 

34600 

0375 

34700 

0376 

34800 


34900 

0377 

35COO 


35100 

0378 

35200 


35300 


35400 

0379 

35500 


35600 

0380 

35700 

0381 


NRITE<6. 1 1000) > COVN (1.11.1*1.6) 

9000 FORMAT ( 1 HI ,5X . 46HG»0UN0 CONTROL POINT SIMULATION PROGRAM GCPS1M 
.//SX.25HRUN START AND STOP TIMES .2F10.0/5X. 

.25MINIT QUATERNION VALUES .4F10.7/5X, 

.2SKINITIAL POSITION VALUES , 3E2 7 . 1 4/30X , 3E27 . 1 4/30X , 5E1 2 . 4/// ) 

10000 FORMAT (5X.25HATT PARAMETER VARIANCES , 8E1 2 . 4/30X . 8E 1 2 . 4 ) 

11000 FOR¥AT(SX,25HNAV PARAMETER VARIANCES .6E12.4/30X, 5E12.4///) 

MR ITEI6. 1 1200) MOP 

11200 FORMAT! / ,4X, ' MODE OF OPERATION • ’,11) 

NRITEI6. 11300) UE.US.UM 

11 300 FORMAT ( 4 X ( 1 GR AV I T A T I ONAL CONSTANTS — EARTH, SUN, MOON ',4X, 

. 3E22.14) 

MRITE(6, 1 1400) J2. J3. 04 

11400 FORMA T ( 4 X , 1 ZONAL GRAVITATIONAL HARMONIC TERMS — 

. ' 02, 03, 04' ,3 22.14) 

MRITE(6. 1 1500) RBE . R80. RBM 

11500 FORMAT ( 4 X , 1 real MORLO RAOU — EARTH, SUN, MOON ' , 1 1 X , 3E22 . 1 4 ) 

MR I TE<6. 1 1600) RAOt. RAOM 

11800 FORMAT ( 4 X , 1 ESTIMATED RADII — EARTH, MOON ',11X, 

. E22. 14. 22X.E22. 14./ ) 

T 1 ME = T S T ART 
T 1 N.TST ART 
T I A*TST ART 
TIS*TSTART 

C* • •••* ......... 

C FOR E0R2, TMEAS READ FROM NAMELIST. IN ALL OTHER CASES NISH IT 

C TO EQUAL TSTAPT. FOR E0R2, HOMEVER, TMEAS IS A CONSTANT OF 30 SECS. 

C ANO MUST 8E R AD IN THROUGH NAMELIST. SEE SPECIAL LOGIC IN EXEC. 

C* ••••••• * 

I F ( M0 P . N E . 2 ) TM AS « TSTART 
MR 1 TE ( 6 . 12000) 1ES 
MRITE(6. 13000) ITS 
MR1TEI6, 14000) IST.IAA 
MRITEI6. 15000) IPA.IPN 
MR 1 T E ( 6 . 16000) 

RE TURN 

12000 FORMAT ( 20X , 16H EVENT GEQUENC ING/ 1 5X , 75H 123456789 

.10 11 12 13 14 15 16 17 18 19 20 21 2» 23 24 25 / 1 5X . 251 3/// ) 

13000 FORMAT (20X.13H EVENT CTCLING/25X . 50HEVENT START - STOP, MAX NO. CYC 
•LES. MAX TIME - HRS /I5X, 6(413, 4X)///) 

14000 FORMAT(20X,12HACTI0N TABLE /20X . 52HCOOE 12345678 
.9 10 11 12 13 14 15 /20X.18HSTAR SPEC I F ICAT ION/3 ( 29X , 1 1 1 3/ ) 20 X , 

. 16HALTERNATE ACT ION/ 3 ( 50X , 4 1 3/ ) /// ) 

15000 F0RMAT(20X.17HPAHAMETER UPOATES /20X.8HATTITUDE.5X , 16I2/18X, 

. 1 OHNAV 1G ATION , 5X , 1 1 I 2///) 

16000 FORMAT ( 1 HI ) 

END 


indata 
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2.2 Event Sequencer (GCPSEQ) 

One of the primary functions of GCPSIM is to analyse the effect of 
different measurement sequences and to establish a baseline sequence which 
will meet the operational requirements. The operations sequencer (GCPSEQ) has 
been designed to allow any sequence of operations to be simulated. 

The GCPSEQ module is responsible for controlling the type of measurements 
performed by the onboard GCP detection system. The possible measurement types 
are identified by an event code as illustrated in Table A-l. The delay times 
listed in the table were chosen to be multiples of the cycle time between two 
coneecutive scans of the mirror in the MSS. This would allow the 
implementation of a scan initialisation signal which would be generated by the 
onboard navigation system to control the scanner of the MSS. Control of the 
scan mechanism in this manner would eliminate the distortions (as large as 28 
P^ xe i*) associated with variation of the scan period and would reduce the 
amount of onboard processing required for image correction. The primary 
interrupt period of the onboard navigation system will be chosen such that it 
divides evenly into the scan period. 

An event sequencing table has been established to identify series of 
events to be performed. The overall mission may be broken down into different 
types of operational sequences defined by partitioning locations in the event 
sequencing table containing the event codes to be performed. A sample event 
sequence table is shown in Table A-l. In the table, the first partition 
contains a sequence which performs a GPS measurement followed by a 10 second 
wait. The second partition contains a sequence where a GPS measurement is 
followed by a #1 star tracker meaurement, a 10 second wait, a second GPS 
measurement, and a #2 star tracker measurement. 


PARTITION 

NUMBER 

— 

1 

2 

3 

1 

4 

SEQUENCE 

NUMBER 

1 2 

3 4 5 6 7 

8 9 10 11 12 13 14 15 

16 17 18 19 

EVENT 

CODES 

2 8 

2 3 8 2 4 

26382648 

3 6 4 6 


Table A-l. Event Sequence Table 
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Partitions within the event sequence table are defined by an event cycling 
table. The cycling table defines partitions in terms of the sequence numbers 
which mark the beginning and end of the sequence within the partition. 

In addition to defining partitions the event cycling table defines either 
the number of repetitions of a partition or the maximum amount of time to be 
spent cycling through a partition. Operations within a partition are 
terminated when one of these limits is reached. A sample event cycling table 
is shown in Table A-2. A partition is defined in terms of the event 
sequence numbers. In the tablet the first event group defines a partition 
beginning at sequence number 1 and ending with sequence number 2. Operations 
within the partition will be repeated five times or for two hours depending on 
which occurs first. 


SEQUENCE SEQUENCE CYCLE REP. CYCLE 

START STOP LIMIT TIME (HOURS) 


PARTITION 

NUMBER 


1 

1 

2 

5 

2 

2 

3 

7 

100 

15 

3 

1 

2 

50 

2 

4 





5 






Table A-2. Sample Event Cycling Table 


GCP measurement are considered to take precedence over all other types of 
events and will therefore be scheduled on a separate basis. A GCP count table 
(Table II-IV) containing all information necessary to locate the predicted GCP 
locator has been implemented in the sequencer. 

The location and size of the search area is completely defined by the line 
start, line stop, element start, and element step indicators contained in the 
count table as shown in Figure A-S . 


A- A 1 



Present Sensor 
Seen Line 


Field of View Over time 



Figure A-5 Explanation of Parameters in Count Table 


In Figure A-5 the two long horizontal lines enclose a diagram of the 
imaging sensor's field of view over time. The vertical swaths depict one scan 
of the sensor s instantaneous field of view, and the small squares within the 
scan line are individual picture elements. The start count contains the 
number of scans between the present scan line and the first line of the search 
area. The stop count contains the size of the search area in scan lines. 

Once it is known that the search area is within the field of view, it is 
necessary to determine its location. The element start count contains the 
distance, in picture elements, of the search srea from the start of the scan 
line. The element stop count contains the distance to the end of the search 
area from the start of the scan line. These four parameters totally describe 
the position and size of the search area relative to the current position of 
the sensor's field of view. The center of the search area is coincident with 
the estimated center of the landmark and its size is a direct function of the 
uncertainty in satellite position and attitude. 



The functional flow of the sequencer is illustrated by the VCLR in Figure 
A-6 . On the first entry into the sequencer, all indices in the sequence 
table, the cycle repetition table and the GCP count table are initialised. On 
all other entries to the sequencer, the event sequence index, ISS, is 
incremented. A test is conducted to determine if the sequence index has 
exceeded the bounds established by the cycling table. If these bounds have 
not been exceeded the event code is read from the sequence table. If the 
limits have been exceeded, the sequence index is set back to the start of the 
event part ition defined by the first column in the cycling table. The cycle 
repetition index is then incremented to indicate the total number of cycles 
through that partition. If the number of cycles does not exceed the limits 
established by the cycling table the event code is obtained directly from the 
sequence table. If the total number of cycles exceeds the limits, the cycling 
rep index and the cycle time are reinitialized to zero and the next partition 
entered by incrementing the event group counters. If the event group counter 
exceeds the number of partitions set up in the cycling table, the simulation 
is effectivly terminated. 

Following extraction of the event code, MCODE, from the sequence table a 
test, is made to determine if the event is a measurement or a delay. If MCODE 
is greater than five, indicating a delay, the measurement time is found by 
adding the length of the delay to the current time. 


If MCODE denotes a measurement a sequence test is initiated. First, a 
test is made to determine if a GPS update is to be made. If it is then the 
measurement time is found by 


TMEAS - TIME+DTGPS 

where: DTGPS is the time required to make the GPS measurement 

If the measurement is not a GPS update a test is made to determine if a 
measurement is being made by star tracker one. If this is the case, a vector 
from the star tracker to the star is generated by the subroutine BVECT. BVECT 
is described later in this chapter. Since the star being observed by the 
tracker might be obscured by a major body such as the sun, moon, or earth, a 
test is made by the subroutine VISIBLE to determine if the tracker is 
occulted. VISIBLE is described later in this chapter. If the first star 
tracker is occulted the process is repeated for the second sLar tracker, and 
if both trackers are occulted the sequencer will delay measurements for a 
period of time. If the measurement code originally indicated a star tracker 
two sighting, the process is performed in the reverse sequence. Assuming that 
one of the star trackers is not occulted the measurement time is found by 

TMEAS - TIME* DTST 

where: DTST is the time required to make a star tracker measurement 


A-4 » 


Following computation of the measurement time, either through 
sequencing or measurement sequencing, a test is performed to J®*®*®™* ** t 
there is sufficient time prior to the next GCP -ighting for the measurement to 
be made. First, the number of scan lines to the GCP is computed by 

LINLEFT - LINNUM-( TIME-TGCP ) /DTPS 

were: LINLEFT ■ number of scan lines remaining to the GCP 

LINNUM ■ number of times between last GCP and next GCT 
TIME * current time 

TGCP ■ the time at which last GCP was sighted 
DTPS * time required per scan line 

If the number of scan lines left to the GCP is larger than the number of 
lines that will be scanned during the planned measurement, the measurement is 
made. If there is insufficient time remaining, the measurement code is set 
1 indicating a GCP sighting and TMEAS is computed. 
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Sequence Operations 

V First visit to sequencer 

Increment event index ISS Initi. 

Store event index as ISEQ 

Vv Sequence index greater than sequenc^^y/T 

Set sequence index to sequence start 

Store sequence index ISS 

Increment cycle repetition index 

Vi Cycle rep or time exceeds limits" 

Increment event gr oup counter 

* V Event group greater than max 

^ Set cycle rep index to 0 

e? Set cycle time to 0 Esj 

— S51 

Set sequence index to sequence sta :t j 

: Store sequence index ISS ! 

Read event code NCODE from sequence table 

K MCODE .GE. 5 

VyJ MCODE ■ EQ ■ 2 

MCODE ,EQ, 3 ^ 

BVECT BVECT 

Generate angle from ST2 Generate angle from STl 
to star ________ to star 


Initialize sequence counters 


Star visible to ST 2 


Star visible to STl 


TMEAS = TIME + 
IDELAY (MCODE) 


TMEAS = 
TIME + 
DTGPS 


MCODE. EQ. 3 
BVECT 

Generate angle 
from STl to star 


TjjEAg = MCODE . EQ . 4 

TIME + BVECT 

DTST Generate angle 

from ST2 to star 


TMEAS = 
TIME + 
DTST 


\ VISIBLE 
\ Star visible 
F\ to STl 


MCODE 


TMEAS = 
TIME + 
IDELAY (5) 


5_ TMEAS= 
TIME + 
DTST 


VISIBLE 7 
V Star visible / 
F\ to ST 2 / T 

MCODE = 5 TMEAS= 

TMKAS - ™ + 

TIME + 

IDELAY (5) 


Generate number of lines left prior to GCP sighting 
K" Time left prior to GCP sighting is less than TMEAS 


MCODE . EQ . 1 




T. 3 ■ time of GCP sighting 




Update GCP index 




Read number of lines to next GCP 






Update GCP time flag 
Return 


Eiger.' A -6 GCPSEQ VCLR 
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VAX-11 FORTRAN V2.0-2 

_DBA0: [ D 1 IR.GC-'jGCPSEQ.FOR . 16 


SUBROUTINE GCPSEQ 
REAL'S ANGLE. CT. ST. VEC 
INCLUDE 'DEBUG. COM „ rD ,, r 

COMMON /DEBUG/ I EN T ER • * DE BUG 

..omietPOC TO VARY DEBUG PRINT LEVEL 
USER CONTROLLED PARAMETERS TO 

Ir > POINTS WHEN ENTERS MOST SUBROUTINES 

i:,;: m«» £. 

logical of lag 

REAL'S PI.TPI 

MEASUR WENT SPECIFICATIONS 

mty pe measurement type 

set for star obstruction 

MCOOE - ■ MEASUREMENT PROCESSING 

PI 

TP I 2'PI 

cS%sS/'i°si 2 5).lTS(4.5),IAA(3.4).lFLAG 

COMMON /Stwu/ dt5T>DIGPS . IDELAY(II) 

REAL'S OTST.DTGPS 
LOGICAL I FLAG 


SEQUENCE OF EVENTS TABLES 


. s EVENT SCHEDULAR 

I TS CYCLE SEQUENCER 

i A F A LAG SE T T E -HEN E tJrGE? N !s OBSTRUCTED 

INCLUDE 'TIME.COM' 

COMMON /TIME/ T lME ’ I^Sl^ns’ TIS^DT aIdATER^T PR I NT ’.DTPr'inT 

* REAL'S TIME TNe'xT TlioP.Tli.DEUTIN’.OTN. DATED. TMEAS. TRACK. TIS. 
REAL'S TXME.TNE t . erq dater tprint> 0 T pri NT 

THESE ARE THE TIME REFERENCE FRAMES 


T IME 

TNEXT 

TSTOP 

TIA 

D L 

T IN 

DTN 

OATEO 

DATER 

TZERO 

TSLEW 

TIS 


atomic TIME SINCE INITIALIZATION (SEC) 
uSe FOR NEXT POSITION INTEGRATION (SEC) 
RUN TERMINATION TIME J^CI 
ATTITUDE INTEGRATION T.ME p (SEC)^ 

POSITION INTEGRATION TIME ^ 

DATE OF FLIGHT EPOCH (JO) 

S^RT°Tli 9 E 5 ?N E SECS. ( S?icE DATED 

TIME NEEDED TO S " E "/*° M p C ?sej^ <SEC 
REAL WORLD REFERENCE TIME (SEC) 


k 


GCPSEO 
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18-Feb-igai 15:30:55 
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02100 

02200 

02300 

07400 

02500 

02600 

00700 0016 

00800 0017 
00800 0018 
00800 0019 
0C900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 
> 02500 

« 02600 
S 02700 
02800 
02900 
03000 
03100 
03200 
03300 
03400 
03500 
03600 
03700 
03800 
03900 
04000 
04100 
04200 
04300 
04400 
04500 
04600 
04700 
04800 
04900 

05000 0020 

05100 0021 

05200 

05300 

05400 

05500 


• c 

• c 

• c 

• c 

• c 

• c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c« 

c 


999 

c 

c* 

c 

c**' 


TISN 

OTA 

tprint 

dtprint 


VAX-11 FORTRAN V2.0-2 

_DBAO : [ D 1 1 R . GCP ] GCPSEO • FOR ; 16 


TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY ♦ DEL BUT ♦ TSLEW - TIA WHEN DEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


INCLUDE 'GCPDAT.COM' 

COMMON /GCPDAT, I GCPOT ( 4 , 1 0 ) . L INNUM. TGCP , I OLMAX , GCPN , DT PS 
REAL-8 TGCP , GCPN . OTPS 
DIMENSION MT( 1 5) ,M3( 15 | . VEC(3) 


THIS PROGRAM DETERMINES EVENT SEQUENCING 
the PROGRAM parameters ARE; 

TIME THE CURRENT FLIGHT TIME 
MTVPE THE TYPE OF MEASUREMENT 

MTYPE = 1 FOR GCP MEASUREMENTS 
MTVPE = 2 FOR GPS NAVIGATION 
MTVPE * 3 FOR STAR TRACKER 1 MEASUREMENTS 
MTYPE = 4 FOR STAR TRACKER 2 MEASUREMENTS 
IS THE STAR NUMBER SPECIFICATION 

JFLAG OPERATIONAL FLAG - SET IF THE 

TARGET IS NOT AVAILABLE 

THE LABELED COMMON (SEQ) PARAMETERS ARE I 
IES EVENT SCHEDULE TABLE 
ITS TIME CYCLING TABLE 
IDT STAR SPECIFICATION TABLE 
MT AND MS RELATE MTYPE AND MSET TO MCODE. RESPECTIVELY 

MCOOE ACTION 


1 

2 

3 

4 

5 

6 

7 

8 
9 

10 
1 1 
12 

13 

14 

15 


VH.P r.it ASUHtMENT 

G°S NAVIGATION 

STAR TRACKER 1 MEASUREMENT 

STAR TRACKER 2 MEASUREMENTS 

DELAY OF XXXXXX US 

DELAY OF XXXXXX US 

DELAY OF XXXXXX US 

delay of xxxxxx us 

DELAY OF XXXXXX US 
DELAY OF XXXXXX US 
DELAY OF XXXXXX US 
DELAY OF XXXXXX US 
delay of XXXXXX US 
delay of xxxxxx us 
delay of xxxxxx US 


IF( I ENTER . EQ . 1 )WR I TE ( 6 . 999) 
FORMAT ( ' ENTERING GCPSEO ') 


FLAG. EQ. FALS- INDICATES NEW SEQUENCE TABLES 


t 


I 

00 


GCPSEQ 




05600 


C 


05700 

0022 


IF(IFIAG) GO TO 10 

05800 

0023 


1 SEQ * ITS( 1.1) 

05900 

0024 


1SS ■ 1SEQ 

06000 

0025 


1R • 1 

06100 

0026 


IC ■ 1 

06200 

0027 


L INNUM * IGCPOTI 1 . 1 ) 

06300 

0028 


TGCP ■ TIME 

06400 

0029 


GCPN « 1 

06500 

0030 


I F LAG « .TRUE. 

06600 

0031 


GO TO 40 

06700 


C 


06600 


O ••• 


06900 


C 

INCREMENT SEQUENCE 

07000 


c* ••• 


07100 


c 


07200 

0032 

10 

ISS • ISS ♦ 1 

07300 

0033 


I SEQ » ISS 

07400 

0034 

20 

IF< ISEQ. LE.IT5I2.IC) ) GO TC 

07500 

0035 

30 

ISEQ • ITS( 1 . IC) 

07600 

0036 


ISS « ISEQ 

07700 

0037 


1R « IR ♦ 1 

07800 

0038 


I F ( I R . LT.ITSO.IC) ) GO Tt 

07900 


C 


08000 

0039 


IC ■ IC ♦ 1 

08100 

0040 


I F ( IC . GT , I PM AX )GQ TO 80 

08200. 

0041 


IR >0 

08300 

0042 


ST « TIME 

08400 

0043 


ISEQ ■ I T S ( 1 .IC) 

08500 

0044 


ISS • ISEQ 

08600 


C 


08700 


c* 


08800 


c 

GET MEASUREMENT COOE 

08900 


0 


09000 


c 


09100 

0045 

40 

MCOOE • I E S ( ISEQ) 

09200 

0046 


IF(MCOOE .NE . 1) GO TO 41 

09300 

0047 


WRITE) 6,41 ) 

09400 

0048 

41 

FORMAT (5X. 'MCOOE ERROR - 

09500 

0049 


CALL EXIT 

09600 

0050 

42 

I F < MCODE . GE . 5 ) GO TO 85 

09700 


C 


09800 


O • 


09900 


C 

GPS MEASUREMENTS’ 

10000 


c* • 


10100 


c 


10200 

0051 


I F ( MCODE -NE . 2 ) GO TO 45 

10300 

0052 


TMEAS * TIME * OTGPS 

10400 

0053 


GO TO 100 

10500 


c 


10600 


C.4.. 


10700 


c 

STAR TRACKER 1 OR 2? 

10800 


C» 


10900 


c 


11000 

0054 

45 

I F( MCOOE . EQ . 3 ) GO TO 50 

11100 


c 


11200 


c» •• 
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VAX-11 FORTRAN V2.0-2 

_DBAO! [ D 1 1 R.GCP ]GCPSEQ . FOR : 16 


Pag* 


1 LIMIT OF PARTITION 
I SET SEQUENCE TO START 


I PARTITION REPITITIONS GT MAX 
1 INCREMENT PARTITION NUMBER 
I PARTITION NUMBER GT MAX 
I REINITIALIZE 


I GET measurement CODE 


■1' i 


GCPSEQ 


1 1300 


1 1400 


1 1500 


1 1600 

0055 

1 1 700 

0056 

1 1 800 

0057 

1 1900 


1 2000 


12100 


12200 


12300 


12400 

0058 

12500 

0059 

12600 

ooeo 

12700 

0061 

1 2800 

0062 

1 2900 


1 3000 


13100 


1 3200 


1 3300 


13400 

0063 

1 3500 

0064 

13600 

0065 

1 3700 


1 3800 


1 3900 


14000 


14100 


14200 

0066 

14300 

0067 

14400 

0068 

14S00 

0069 

14600 

0070 

14700 

0071 

14800 

0072 

14900 


15000 


15100 


15200 


15300 


15400 

0073 

15500 

0074 

156C0 


15700 


15800 


15900 


1600 ' 


16100 

0075 

16200 

0076 

16300 


16400 


16500 


16600 


16700 


16B00 

0077 

16900 

0076 


6-Apr-l 981 14:47:55 VAX-11 FORTRAN V2.0-2 
18-F»b-1981 15:30:55 _DBA0: [01 1 R .GCP ]GCPSE9. FOR ; 16 

C STAR TRACKER 2: CHECK TO SEE IF VISIBLE AND GET ANGLE TO STAR 

c * 

CALL 8VECT ( V EC . 2 ) 

CALL V ISIBLE ( VEC.4 . JF L AG ) I IS TRACKER OCCULTED 

IF< .NOT . JFL AG) GO TO 55 
C 

C« ...... ...... ......... 

C OTHERWISE STAR TRACKER 1 MEASUREMENTS 

C» ............. .***.... 

c 

MCOOE * 3 

CALL BVECTI VEC.1 ) 

CALL VISIBLE (VEC. 4, JFlAG) I IS TRACKER OCCULTED 

IF( .NOT . JFLAG) GO TO 55 
GO TO 05 
C 



C STAR TRACKER 1 MEASUREMENTS 

C. .................................... 

c 

50 call BVECT( VEC. 1 ) 

CALL VISIBLEIVEC.4. JELAG) I IS TRACKER OCCULTED 

IF( .NOT . JFLAG) GO TO 55 
C 

C* 

C OTHERWISE STAR TRACKER 2 

c ................... .....MM 

C 

MC0DE.4 

CALL BVECTIVEC.2) 

CALL V ISIBLE (VEC.4 .JFLAG ) I IS TRACKER OCCULTED 

I F ( . NQ T . JFLAG) GO TO 55 
GG TO 85 

55 TMEAS « TIME + OTST 

GO TO 100 
C 

C* .................................... .................... ...... 

C JUMP TO LAST delay 

C. •••*••* 

c 

80 MCODE * 1 5 

GO TO 07 
C 

C. .................. 

C SET UP NORMAL DELAY 

C. .................. * **••«. ...... 

c 

05 MCOOE* 5 

87 TMEAS. TIMEt-I D LAY ( MCODE- 4 ) 

C 

c» *.•••*.. 

C CHECK FOR TIM TO MAKE GCP MEASUREMENTS 

C. ............ 

C 

100 LINLEFT»LlNNUM-( T I ME-TGC P ) /OTPS 

IF( LINLEFT , GT . ( TME AS-T IME ) /DTPS) GO TO 200 


Rag* 4 


GCPSCQ 
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VAX-11 FORTRAN V2.0-2 
_OBAO: [011R.GCP1GCPSE0.F0B; 16 


17000 


C 

17100 


C* •* 

17200 


c 

17 300 


C* •• 

17400 


C 

17500 

0079 

60 

17600 

0080 


17700 


c 

17800 


c 

17900 

0081 


18000 

0082 


18*00 

0083 


16 .00 

0084 

200 

1B300 

0085 



GCP MEASUREMENTS 


MCOOE* 1 

TMEAS • (TIME ♦ L I NLEFT • OTPS ) 


I COMPUTE MEASUREMENT TIME 


GCPN - GCPN ♦ 1 (TEMPORARY 

CCPN . 1 ! TEMPORARY FOR LONG RUN - JACK 

LINNUM- IGCPDT(1 .GCPN) 

TGCP • TMEAS ♦ IGCP0T(2.GCPN)/0TPS 

RETURN 

ENO 


program sections 


Name 

0 SCOOE 

1 SPOATA 

2 (LOCAL 

3 DEBUG 

4 TARGETS 

5 SEOU 

6 TIME 

7 GCPOAT 


Bytes 

At t r 

< butes 


553 

PIC 

CON 

REL 

LCL 

59 

PIC 

CON 

REL 

LCL 

236 

PIC 

CON 

REL 

LCL 

8 

PIC 

OVR 

REL 

GBL 

36 

PIC 

OVR 

REL 

GBL 

292 

PIC 

OVR 

REL 

GBL 

136 

PIC 

OVR 

REL 

GBL 

192 

PIC 

OVR 

REL 

GBL 


SMR 

EXE 

RO 

NOWRY 

LONG 

SHR 

NOEXE 

RO 

NOWRT 

LONG 

NOSHR 

NOEXE 

RD 

NRT 

OUAD 

SHR 

NOEXE 

RD 

NRT 

LONG 

SHR 

NOEXE 

RD 

WRT 

LONG 

SHR 

NOEXE 

RO 

WRT 

LONG 

SHR 

NOEXE 

RO 

NRT 

LONG 

SHR 

NOEXE 

RO 

NRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 GCPSEO 


VARIABLES 

Address 

2-00000090 

6-00000020 

6-00000080 

2- 00 OOOOBC 

3- 00000000 

4- 00000004 
2-000000C0 
4-00000008 
6-00 0000 IB 
6-00000060 
6-0000007B 


Type 

Name 

R*8 

ANGLE 

R*8 

DEL 

R*8 

DTPRINT 

1*4 

I 

1*4 

IENTER 

|*4 

IS 

|*4 

linleft 

1*4 

NS 

R*8 

T t A 

R*8 

TISN 

R*8 

TPRINT 


Add '-ess 

Type 

Name 

2-00000090 

R*8 

CT 

6-00000068 

R *8 

OTA 

7-000C00B8 

R*0 

OTPS 

2-00000004 

I *4 

IC 

5-OOOOOOE4 

L*« 

I FLAG 

2 -00000 0A8 

I • 4 

IS EG 

7-000000A0 

I *4 

LINNUM 

4-00000014 

R*8 

PI 

6-00000000 

R *8 

TIME 

6-00000048 

R*B 

TMEAS 

6-00000050 

R*8 

TRACK 


Address 

type 

Name 

6-00000038 

R* 8 

dateo 

S-OOOOOOFO 

R* 8 

DTGPS 

5-OOOOOOE8 

R*8 

OTST 

3-00000004 

1*4 

IDE BUG 

2-00000088 

1*4 

IPMAX 

2-00 OOOOAC 

1*4 

ISS 

4-00000010 

1*4 

MCOOE 

2-000000A0 

R*8 

ST 

6-00000028 

R*8 

TIN 

6-00000008 

R*B 

TNEXT 

6-00000010 

R*8 

TSTOP 


Address 

Type 

Name 

6-00000070 

R*8 

DA TER 

6-00000030 

R*B 

DTN 

7-OOOOOOBO 

R»B 

GCPN 

7-OOOOOOAC 

1*4 

IOLMAX 

2 -C0000080 

1*4 

IR 

4-OOOOOOOC 

L*4 

JFLAG 

4-00000000 

1*4 

MT YPE 

7-OOOOOOA4 

R * 8 

TGCP 

6-00000058 

R *8 

TIS 

4-0000001C 

R *8 

TP I 

6-00000040 

R*8 

TZERO 


GCPSEQ 


ARRAYS 
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WAX-11 FORTRAN V2.0-2 
_DBAO: [D1 1R.CCPJGCPSE0.F0R : 16 


F«g« 


Address 

Type 

Name 

By t es 

D 1 mens ions 

5-00 0000B4 


4 

IAA 

48 

( 3 , 4) 

5-OOOOOOFB 


4 

IDELA Y 

44 

Ml) 

5-00000000 


4 

IES 

1 00 

(25) 

7-00000000 


4 

IGCPCT 

1 60 

{ 4 , to ) 

5-00000064 


4 

ITS 

00 

(4, 5) 

2-00 000054 


4 

MS 

60 

(15) 

2-00000018 


4 

MT 

60 

( 15) 

2-00000000 

R 

8 

VEC 

24 

(3) 


LABELS 


Address 

0-00 00006 A 
0-00 0001 1 A 
0-00 0901 9E 

Labe l 

10 

45 

87 

Address Label 

•• 20 
0-0000 0 1 4E 50 
0-090001B9 100 

Address 
• • 

0-000001 7C 
0-00000228 

Label 

30 

55 

200 

Address 

0- OOOOOOCl 

• • 

1- 00000000 

Labe 1 

40 

60 

999' 

Ad dr ess 

1-00000014 
0-0000 Ot BE 

LaO* 1 

4 1 ' 

80 

Addlres s 
0— 000000 F0 

0-00000197 

Label 

42 

■S 

FUNCTIONS ANO 

SUBROUTINES REFERENCED 









BVECT 

FORSEXIT 

VISIBLE 










Total Space Allocated • 1512 Bytes 


COAMAno qualifiers 

FORTRAN /LIST GCP.INOA 


1. OUT OAT A . RUNG . ON AV , EP„EM, TRL/EA , spress .occult.gpert .gcpseo. visible .GENENV . TREG.GYRQUT .RATE ,MAT ,CMA 


/CME CK*( NO BOUNDS .OVERF low I 
/DEBUG- ( NOSYMBOL S . TRAC EBACK ) 

/F77 /NOG.FlOATING /I4 /OPTIMIZE /WARNINGS /NOO_LIN£S /NGMACHINE.COOE /CONT INUAT IONS- 1 » 


COMPILATION STATISTICS 


Run Time: 

E I epsed Time: 
Page Faults: 
Dynamic Memory: 


2.52 seconds 
27.61 seconds 
372 

ISO pages 


2.2.1 CHECK FOR STAR OCCULTATION (VISIBLE) 

Subroutine VISIBLE act* n an axacutlva for tha determination of «hathar 
the taraat 1 atari* occul tad by a major body. Tha bodia. chack.d are tha 
orth, noon, and aun. Tha occultation geometry i* checked ^ J 11 ' "J “ f 
•ubroutine OCCULT a unit vector to tha target atar, a vector to occult 

the of concern and the effective r.diu. of the body of concern. OCCULT 

then «turn. a .TRUE, in tha logic variable L if the atar i. occulted by the 
body. Figure A-7 ia a VCLR of the proceaa. 

Input Variable* and Output Variable* . 

VEC • Unit vector to the target atar. (Unitleas; 

RSO ■ Radiua vector to the *un (KM) 
ggn ■ obstruction radiu* of the aun (KM) 

RSM • Radius vector to the noon (KM) 

■ Obstruction radiua of the noon. (KM) 
m R»diua vector to the earth. (KM) 


RBM 
R 


RBE ■ Obstructing radius of the earth (KM) 
L - Logical flag . TRUE, if occulted. 
Calling Routine* - GCPSEQ, MEASURE 


Routine and Function* Called - OCCULT 


A-52 


VISIBLE - VCLR 



Figure A- 7 


A-53 





6-Apr-19b1 14:40:25 VAX-11 FORTRAN V2.0-2 
30-Sep-1 980 00 . jO: 1 4 _DBA0! [0 1 1 R . GCP I V I S I BLE . FOP ! 5 


00100 

0C200 

00300 

00400 

00500 

001-00 

00200 

00300 

00400 

00500 

00600 

00700 

OOGOO 

00700 

00700 

00700 


0001 

0002 

0003 

0004 

0005 

0006 


0007 

0008 


0009 


00700 
00700 
00800 
00800 
00800 
00800 
00800 
ooqoo 
00800 
00800 
00800 
00800 
00800 
00800 
00800 
00800 
30800 
00800 
00800 
00800 
00800 
00900 
01009 
01 100 
01200 
01300 
01400 
01500 


0010 
001 1 
0012 


0013 

0014 

0015 


SUBROUTING VI5IBLElVFU.N0, L) 

DIMENSION VEC( 3) 

REAL*8 V.2ETL.V C.VMAG 
LOGICAL L 

INCLUDE 'DEBUG. COM' 

COMMON / OEBUG/ I EN T F R , . DEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 


I NtER 
IOEBUG 


IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
0-10. HIGHER NUMBER MEANS MORE PRINT 


INCLUDE 'RVEC.COM' 

COMMON / RVEC/ R ( 3 ) , RM 1 3 ) . RO ( 3 ) , R SM( 3 ) , RSO( 3 ) . RSS ( 3 ) , SB( 3 ) 
, R A , R 2 , R3 , R SMA , R TG ( 3 ) 

RE AL*8 R .RM.RO .RSM.RSO.RSS.SB.RA , R2 , R3 , RSMA , RTG 


00700 

* C 

THESE ARE 

RADIUS VECTORS IN ECI AND 

BODY COORDINATES 

00700 

• C 





00700 

» C 

R 

EARTH CENTER TO S/C - 

ECI 

(KM) 

00700 

• c 

RM 

” ’ MOON 

- ECI 

(KM) 

00700 

» C 

RO 

" • SUN - 

ECI 

(KM) 

00700 

• c 

RSM 

SPACECRAFT TO MOON - 


ECI (KM) 

00700 

* c 

RSO 

“ SUN - 


ECI (KM) 

00700 

* c 

RSS 

EARTH CENTER TO STAR 

- ECI 


00700 

* c 

RA 

ABSOLUTE OF VECTOR R 

(KM) 


00700 

* c 

R2 

SQUARE OF RA (KM 2) 



00700 

• c 

R3 

CUBE OF RA (KM 3) 



00700 

* C 

RSMA 

ABSOLUTE OF RSM (KM) 




INCLUDE 'C0NST.COM' 

COMMON /CONST/ ATM, RBM , RBE . RBO , R E2 . RM2 , UM, US , UE , J2 . J3 , J4 , DTU , P K1 
REAL'S ATM. RBM, RBE , RBO . R E2 , RM2 , UM , US , UE , J2 , J3, u4 , DTU. PK1 


PROGRAM CONSTANTS 


ATM 

RBM 

RBE 

RBO 

R .2 

RM2 

UM 

US 

U . 

U2.J3.J4 

DTU 

PKI 


STAR AVAI LABILITY 


S/C AREA TO MASS RATIO (METERS/KG) 
OBSTRUCTION RADIUS OF THE MOON (KM) 

« " EARTH (KM) 

" “ SUN (KM) 

SQUARE OF THE EARTHS RADIUS (KM 2) 

* LUNAR RADIUS ( KM 2 ) 

LUNAR GRAVITATION CONSTANT (KM 3/SEC 2) 
SOLAR * “ " 

EARTH * " “ 

ZONAL GRAVITATIONAL HARMONIC TERMS 
REGULARIZED TIME STEP SIZE (SEC) 

30LAR PRESSURE CONSTANT 


I F ( I ENTER . FQ. 1 ) WRirE(6.999) VEC.NO 
FORMAT ( 1 ENTERING VISIBLE ',3F15.5,I5) 
IF(NO.EQ.I) GO TO 10 


Page 1 


999 


VISIBLE 


6-Apr-1981 14:48:25 
30-Sep-1 980 08=30:14 


VAX-11 FORTRAN V2.0-2 
_DBAO= (01 1R.GCP]VISIBLE. FOR; 5 


Page 


01600 
01 70C 


C 

£ * ****** ****** ****** ****** * **** ***********##****^*#****#* + **********#^********* 

0.800 


C 

IS the target occulted by the sun 

01900 


C* * 


02000 

0016 


CALL OCCULT) RSO.VEC , CBO, L) 

02100 

0017 


I F ( L ) GO TO 40 

02200 

ooie 


IF1N0.EQ.2) GO TO 20 

02300 


c* • 


02400 


c 

IS THE TARGET OCCULTED BY THE MOON 

02500 


c* ****** ****** ****** ****** • •* *** ****.■*****•*******•*•***•***************•******* 

0260C 

0019 

10 

CALL OCCULT ' RSM.VEC , RBM , L ) 

02700 

0020 


I F ( L ) GO TO 40 

02800 

0021 


IF (NO. £0-3) GO TO 30 

02900 


c* * 


03000 


c 

IS the TARGET OCCULTED BY THE EARTH 

03100 


c* * 


03200 

0022 

20 

CALL OCCULT ( R . V C.RBE.L) 

03300 

0023 


I E ( L ) GO TO 40 

03400 

0024 


I F ( NO . EQ . 4 ) GO TO 50 

03500 


c* * 


j3600 


c 

IS THE TARGET OCCULTED BY THE S/C 

03700 


o * 


03800 

0025 

30 

V * VMAG ( VEC ( 3 ) 

03900 

0026 


IF(VEC(3 )/V.GT .ZETL) GO TO 50 

04000 

0027 

40 

L > .TRUE. 

04100 

0028 

50 

RETURN 

04200 

0029 


END 


PROGRAM sections 



Name 

Bytes 

At t r i butes 


0 

SCODE 

197 

PIC CON REL 

LCL 

1 

SPDATA 

32 

PIC CON REL 

LCL 

2 

SLOCAL 

108 

PIC CON REL 

LCL 

3 

DEBUG 

8 

PIC OVR REL 

GBL 

4 

RVEC 

224 

PIC OVR REL 

GBL 

5 

CONST 

112 

PIC OVR REL 

GBL 


ENTRY POINTS 
Address 
0-00000000 

Type 

Name 

VISIBLE 




VARIABLES 

Address 

Type 

Name 

Address 

Type 

Nam* 

5-00000000 

R*8 

ATM 

5-00000060 

R*a 

DTU 

5-00000048 

R*8 

02 

5-00000050 

R*8 

03 

AP-00 000008* 1*4 

NO 

5-00000068 

R*8 

P” ' 


SHR 

EXE 

RD 

NOWRT 

LONG 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

NO SHR 

NOEXE 

RD 

WRT 

QUAD 

SHR 

NOEXE 

RD 

WRT 

LONG 

SHR 

NOEXE 

RD 

WRT 

LONG 

SHR 

NOEXE 

RD 

WRT 

LONG 


Address 

Type 

Name 

Address 

Type 

Name 

3-00000004 

1*4 

I DEBUG 

3-00000000 

1*4 

I ENTER 

5-00000058 

R*8 

04 

AP-OOOOOOOC* 

L *4 

L 

4-000000B0 

R*8 

R2 

4-000000B8 

R*8 

R3 


95 - 


Pag* 3 


VISIBLE 


4- 00 OOOOA8 R*8 RA 

5- 0000002 R*8 RE2 

5-00000030 R*8 UM 


6- Apr*- 1 981 14:48:25 
30-Sep- 1 980 08:30:14 


VAX-11 FORTRAN V2.0-2 
_DBA0: [D1 1R.GCP]VISI BLE. FOR: 5 


5-00000010 R»8 RBE 

5-00000028 R«8 RM2 

5-00000038 R*8 US 


5-00000008 R»B RBM 

4-00 0000C0 R»8 RSMA 

2-0000C000 R*8 V 


5-00000018 R * 8 RBO 
5-00000040 R*8 UE 

2-00000008 R*8 2ETL 


ARRAYS 


Address Type Name 


4-00000000 
4-00000018 
4-00000030 
4-00000048 
4-00000060 
4-00000078 
4—00 OOOOC8 
4-00000090 


R»8 

R»8 

R*B 

R*8 

R»8 

R*8 

R*8 

R»B 


AP— 00 0000 04 # R*8 


R 

RM 

RO 

RSM 

RSO 

RSS 

RTG 

SB 

VEC 


Bytes Di mens Iona 


24 

24 

24 

24 

24 

24 

24 

24 

24 


(3) 

(3) 

(3) 

(3) 

(3) 

(3) 

( 3 ) 

(3) 

(3) 


LABELS 

Address Labe 1 
0-00000069 10 


Address Label 
0-00000085 20 


> FUNCTIONS AND SUBROUTINES REFERENCED 
OCCULT VMAG 


Address Label 

0-000000 A1 30 


Address Label 
0-000000C0 40 


Address label 
0-000000C4 50 


Address Label 
1-00000000 999* 


Total Space Allocated » 681 Bytes 


COMMAND qualifiers 

FORTRAN /LIST GC P . INDATA 


.MAT AB, OUT OAT A . RUNG , ON AV , EPH EM , TRUEA , SPRESS , OCCULT , 


GPERT , GCPSEQ . VISIBLE, GENENV.TREG.GV ROUT .RATE , BMAT , CMA 


/CHECK=(NO BOUNDS .OVERFLOW) 

/F77 U ^/NOG^FLOAT ^NG^ / 14^/OPT IMI2 E /WARNINGS /NOO.LINES /NOMACHINE.COOE /CONT INUATIONS-19 


COMPILATION STATISTICS 


Ren Time: 
Elapsed Time: 
Page Faults: 
Dynamic Memory: 


1.19 seconds 
13.87 seconds 
351 

160 pages 


2.2. 1.1 SUBROUTINE OCCULT (RSB, RSS, RB,L) 

Subroutine OCCULT determines whether the target star is occulted by the 
major body of concern. 

Processing Requirements 

The processing uses the dot product of the two vectors RSS and RSB and 
compares the sine of the included angle with the sine of the angle opposite RB 
in such a manner as to not require trigonometric functions. 

Star 



S/C 


Figure A-8 Occultation Geometry 



In referring to Figure A-8, if a is greater than 8, the star will not be 
occulted. Further it may be seen that,g<90 for all spherical oodies. 
Therefore, given 

RSS-RSB - | RSS 1 |RSB|Cos a 


if the following condition doe9 not exist the star is occulted 
Test A 

RSS-RSB <0 , a i 90° 


A second condition that roust exists is that be greater than B. 

Sina > SinB is also a valid condition indicating a > B 

and so is 

(Sina) 2 > (Sina) 2 provides a < 90° 

Since 

(Sina) 2 = 1 - (Cosa) 2 = 1 - / R S? ' RSB \ 

UrssTTrsbT/ 

and 

(SinB)^ -/ Rb \ 2 

\TEHT/ 


Non occuitation is therefore implied by 

/ RSS -RSB V /MV 
1 “ I I r.'o'n' I I d'c'd J y RSB / 


RSS RSB 


or Test B 



> (RB) 


2 


Both of these expressions (A) and (B) are used in the program. Figure A-9 is 
a VCLR of the process. 


A— 38 



Input Requirements 


RSS ■ BSI unit vector to the target star (unitless) 
RSB ■ BCI vector to the body of concern. (KM) 

RB ■ Obstruction radius of the body of concern. (KM) 


Output Requirements 

L - Logical variable. TRUE, if the target star is occulted, otherwise 
.FALSE. 


Subroutine and Functions Called - VMAG, VDOT 
Calling Subroutine - VISIBLE 


A- r W 


OCCULT - VCLR 


INITIALIZE L - TRUE 

CALCULATE MAGNITUDE OF 


VECfOR TO BODY 

^ CRITERION Z SATISFIED ^ 

my 

V CRITERION 1 / 

A SATISFIED A 

NULL 

L 



-.FALSE, 

NULL 


Figure A-9 


A-bO 
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VAX-11 FORTRAN V 2.0-2 
_DBAO: [01 1 R . GC >’ ] OCCULT . FOR ; 7 


00100 

0001 



SUBROUTINE OCCULTiBS i.R>S.RB.U 

00200 



c« •»* 


00300 



c 

THIS ROUTINE DETERMINES IF SAIELLITEISIIS being 

00400 



c 

SHAOEO BY BOUf 8: MSS IS EC I VECTOR FROM SATELLITE TO 

00500 



c 

TARGET, MSB IS The CCI VECTOR TO THE BODY, ANO rb IS THE 

00600 



c 

OBSTRUCTED BOOT RADIUS. L IS TRUE FOR SHADING 

00700 



c 


O'- 800 



c 

THE METHOD us S THE DOT PRODUCT OF RSS AND RSB ANO 

00900 



c 

COMPARES THE SINE O' The INCLUDED ANGLE WITH THE 

01000 



c 

SINE OF THE ANGLE 0PP0S1T RB IN SUCH A WAY AS T 0 

01100 



c 

NOT NEED TRIG FUNCTIONS 

01200 



c 


01 300 



c 

CALLING routine - visible 

01400 



c 


01500 



c 

CALLED ROUTIN S - VMAG 

0 1600 



c 

VDOT 

01700 



c 


01800 



c 

CHECKED BY BACK VYCRS 2UUNE1980 

01900 



c 


02000 



c* 


02 1 00 

0002 



INCLUDE 'DEBUG.COM 

00100 

0003 

• 


COMMON /DEBUG/ I EN T E R . I DEBUG 

00200 


• 

c 


00 300 


* 

c 

USER CONTROLLED PARAMETERS TO VARY OE BUG PRINT LEVEL 

00400 


• 

c 


00800 


• 

c 

I NT£R IF 1, PRINTS WHEN ENTERS M"ST SUBROUTINES 

00600 


• 

c 

IDEBUG O-’O. HIGHER NUMBER MEANS MORE PRINT 

00700 


• 

c 


02200 

0004 



DIMENSION RSB ( 3) , RSS 1 3 ) 

02300 

0005 



REAL*8 ra.rb.rdr.rsb.bss.voot, vmac 

02400 

0006 



LOGICAL L 

02500 

0007 



L * .TRUE. 

02600 

0008 



RA = VMAGIRSB, 3) 

02700 

0009 



RDR = VDOT ( RSB , RSS . .3 I 

02 POO 

0010 



IF ( RA**2-RDR*» 2/ VMAGi RSS , 3 ) *»2 . GE . RB ♦ RB ) L« . FALSE . 

02900 



c* *•« 


03000 



c 

TO COVER POSSIBLE PROBLEMS ARISING FROM THE SQUARING 

03100 



c 

PROCESS ABOVE 

03200 



c • • •« 


03300 

0011 



I E < RDR . LE. 0. )L*. FALSE. 

03400 

0012 



IF (IDEBUG .GT. 3) wRITE(6.999) RSB.RSS.RB.L 

03500 

0012 


99 9 

FORMAT ( 4 X , ' ON _X I T I NG OCCULT '.7F13.2.L5) 

03600 

001 » 



return 

03700 

00*5 



END 


OCCULT 


6-Apr-1981 14:47:36 
29-Oct - 1 980 11 : SO: 55 
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PROGRAM SECTIONS 


VAX-11 FORTRAN V2.0-2 
_DBA0: [01 1 R . GC P [OCCULT . FOR ; 7 


Name 


0 scooe 

1 SPCATA 

2 SLOCAL 

3 DEBUG 


ENTRY points 


Bytes Attributes 


199 

35 

84 

8 


PIC CON REL LCL SHR 
PIC CON REL LCL SHR 
PIC CON REL LCL NOSHR 
PIC OVR REL CBL SHR 


EXE 

NOEXE 

NOEXE 

NOEXE 


RD NOWRT LONG 
RD NO ART LONG 

RD art quad 

RD ART LONG 


Address Type Name 
0-00000000 OCCULT 


VARIABLES 


Address Type 

Name 

Adcress 

Type 

Name 

Address 

Type Name 

3-00000004 I *4 
AP-OOOOOOOC# R<*8 

10EBUG 

RB 

3-00000000 

2-00000008 

I *4 
R*8 

I ENTER 
ROR 

AP-00000010* 

L*4 L 

ARRAYS 







Address Type 

Name 

Bytes 

0 i mens i ons 



AP-00 000004# R»8 

RSB 

24 

24 

(3) 

(3) 




A P-00 000008# R*8 

RSS 





Address Type Name 
2-00000000 R*8 RA 


LABELS 

Address Label 
1-00000000 99' 


FUNCTIONS and subroutines referenced 

VDOT VMAG 


Total Space Allocated « 326 Bytes 


COMMAND QUALIFIERS 


fortran /list gcp. indata. matab.outdata, rung. onav 

/CHECK* (NO BOUNDS .OVERFLOW) 

/OEBUG* (NO SYMBOL S. TRAC EBACK) 

/F77 /NOG.FLOAT ING /I4 /OPTIMIZE /WARNINGS 


. EPHEM, TRUE A, SPR ESS, OCCULT , GPERT , GCPSEQ, VISIBLE. GENE 
/NOD.LINES /NOMACHIN£_COOE /CONTINUATIONS- 19 


NV. T REG. GYROUT, RATE 


.BMAT.CMA 


OCCULT 


6-Apr-19B1 14:47:36 VAX-11 FORTRAN V2.0-2 
29-Oc t - 1 980 1 1:50:55 _DBAO: [ D 1 1 R. GCP 10CCU LT . FOR : 7 


COMPILATION STATISTICS 


Run T i me : 

£ i ap sed T t me : 
Page Faults: 
D/namic Mtnory! 


0.87 seconds 
9.62 seconds 
351 

160 pages 


Page 3 


2. 2. 1.1.1 Compute vector to star (BVECT) 


The function of thie module is to compute a unit vector in inertial space 
pointing along the boresight of the Kth star tracker where K is an input. The 
process, illustrated by the VCLR in Figure A-10 , begins by establishing a unit 
vector in star tracker coordinates defined by 


U 


f *| 

0 

0 

1 


Note that the z axis of the star trackers point along the boresight. This 
vector is transformed into body coordinates using a two step process. First, 
the vector is transformed from star tracker coordinates to nominal star 
tracker coordinates to account for known misalignments. The resulting vector 
transformed from nominal star tracker coordinates to body coordinates to 
account for orientation of the sensor. 


The transformation from body coodinates to inertial coordinates is 
computed by the subroutine AMAT . This transformation matrix is then used to 
transform the boresight vector into inertial coordinates. 


A-64 


Figure II-3 BVECT 


Form unit vector in star tracker coordinates 
along the sensor boresight 


Transform unit vector into nominal star tracker 
coordinates to account for known misalignment 


AMAT 

Compute transformation from body 
to inertial coordinates 


Transform unit vector in body coordinates 
into inertial coordinates 


Return vector to star 
in inertial coordinates 


Figure A-10 


K-b r J 



6-Apr-190i 14:54:38 VAX-11 

11 -See-1 980 11 : C3: 38 _DBA0: 


0001 


0002 

0003 

0004 


0005 

0008 

000 * 


0008 

0008 

0010 


0011 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

V 

c 

c 

c 

c 

c 

c 

c 

r. 


c 

c 

c 


SUBROUT INF BVECT1 VEC T .K ) 


THE FUNCTION OF SUBROUTINE BVECT IS TO ESTABLISH A UNIT 
VECTOR ALONG THE INSTRUMENT BOBESIGHT FOR THE KTH STAR 
TRACKER. THE VECTOR WILL BE KNOWN IN INERTIAL SPACE. 

INPUT PARAMETERS 

K > AN INTEGER DEFINING THE STAR TRACKER 

TO BE USED 


OUTPUT PARAMETERS 

VECT • A UN 1 1 VECTOR KNOWN IN INERTIAL SPACE 
CEFiNING THE B0RES1GHT OF THE 
KTH STAN TRACKER 


WRITTEN BY JACK MYERS - 2 JUL Y 1 580 

EXT 4443 


INCLUDE 'ENVIR.COM' 

COMMON /EMVIP/ STATE!10).PR0TILE(10.4).1NIT 
RCA L *8 STATE. PROFILE 

REAL WORLD STATE PARAMETERS 

STATE state values: X. Y.Z.XO.YO.ZO.EO.El .E2.E3 

PROFILE ATTITUDE PROFILE-TIME (SEC) vs 

INERTIAL ANGULAR RATES (RAO/SEC) 

INIT INTEGRATION INITIALIZATION KEY (-1) 


INCLUDE 'STARPAR.COM 1 

COMMON /STARPAR/ BS ( 2.2) , a S ' 2, 2 ) . TNS (0,3,2), TBNS( 3 ,3,2), 
BSK (2.2). SSK ( 2 . 2 ) . T NSK 13,3,2) 

Rt AL»P BS.SS.TNS.TBNS.BSK . SSK.TNSK 


STAR TRACKER PARAMETERS 

IN EACH CASE THE LAST SUBSCRIPT REFERS TO THE 
TRACK R USED 

BS • BIAS - ACTUAL (RAD) 

SS « NOISE STANDARD DEVIATION - ACTUAL (RAO) 

TNS • MISALIGNMENT ARRAY - TRANSFORMATION FROM 

STAR TRACKER TO NOMINAL 

TONS • OR I NTATION ARRAY - TRANSFORMATION FROM 

NOMINAL TO BOOT 

BSK • BIAS - KNOWLEDGE (RAD) 

SSK « NOISE STANDARD DEVIATION -KNOWLEDGE (RAD) 

TNSK • MiSALlGNMENi KNOWLEDGE ARRAY - TRANSFORMATION 
FROM STAR TRACKER TO NOMINAL 


EQUIVALENCE ,0.STATE(7)) 

DIMENSION UN I T ( 3 ) . UN I T 2 ( 3 ) . A 1 ( 3 . 3 > . B1 ( 3 , 3) , VECT< 3) 
RE AL»8 VECT, UNIT, UNI T2.A1 . B1 .0 


GENERATE A UNIT VECTOR IN TRACKER COORDINATES 


UW I T I 1 )«0. 


FORTRAN V2.0-2 
[01 1 R . GC P ] BVECT . 


BVECT 


6-Apc'l 981 14:54:38 
1 1 -Sep-1 980 11 : 02 : 38 


VAX-11 FORTRAN V2.0-2 
_0BA0 t [ D 1 1 R • GCP ] BVECT . FOR : 4 


P*0* 


0012 


UN I T ( 2 ) * 0 . 

0013 




c 

TRANSFORM TO INERTIAL SPACE __ 

001 4 

c* • • • 

CALL MAT AB1 TNSK( 1 ,1. K), UNIT. UNIT2, 1,3.1) 

0015 


CALL MATAB(TB»4S(1 ,1 . K) ,UN 1 T 2 , UN l T , 3 , 3 . 1 ) 

0016 


CA LL AMATO. A1 ) 

0017 


DO 10 1*1,3 

0018 


DO 10 d* 1 ,3 

0019 

10 

81 ( I ,d)«A1 (d,I ) 

0020 


CALL MATAB(B1 .UNIT, VECT. 3.3,1 ) 

0021 


RETURN 

0022 


END 


PROGRAM SECTIONS 


Name 

0 (code 

1 SPOATA 

2 SLOCAL 

3 ENVIR 

4 STARPAR 


Bytes Attrioutes 


1 43 
B 

316 

404 

560 


PIC CON REL LCL SHR 
PIC CON REL LCL SHR 
PIC CON REL LCL HOSHR 
PIC 0 VR REL GBL SHR 
PIC QVR REL GBL SHR 


EXE 

RD 

NOWRT 

LONG 

NOEXE 

RD 

NOWRT 

LONG 

NOEXE 

RD 

WRT 

QUAD 

NOEXE 

RD 

WRT 

LONG 

NOEXE 

RD 

WRT 

LONG 


ov ENTRY POINTS 

'j 

Address Type Name 
0-00000000 BVECT 


VARIABLES 






Address 

Type 

Name 

Address 

Type 

Name 

2-OOOOOOCO 

1*4 

I 

3-00000190 

I *4 

IN I T 

3-00000030 

R*8 

0 





Address Type Name 

2-000000C4 1*4 d 


Address Type Name 
AP- 000000 080 1*4 K 


ARRAYS 

Address 

2-00000030 

2- 00000078 
4-00000000 
4-C00001 60 

3- 00000050 

4- 00000020 
4-00000180 

3- 00000000 

4- 00000000 


Type Name 

R*8 A 1 
R*8 B1 
R*8 BS 
R*8 BSK 
R*8 PROFILE 
R*8 SS 
R*8 SSK 
R*8 STATE 
R*8 TBNS 


Bytes 

D i mens i oni 

72 

(3. 3) 

72 

(3. 3) 

32 

(2, 2) 

32 

(2-, 2) 

320 

(10, 4) 

32 

(2, 2) 

32 

(2, 2) 

80 

(10) 

1 44 

(3, 3, 2) 


BvECT 


Pag* 


6-Apr-1981 14:54:36 VAX-11 FORTRAN V2.0-2 
ll-Sep-1980 11:02:38 _DBA0 : [D 1 1 R .GCP ] BVECT . FOR : 4 


4-00000040 
4-000001 AO 
2-00000000 
2-ooooooie 

AP-00 000004 9 


R*8 

TNS 

1 44 

(3. 

3. 

2) 

R»8 

tnsk 

1 44 

(3, 

3, 

2) 

R*8 

UNIT 

24 

(3) 


R-8 

UNITS 

24 

(3) 



R»8 

VECT 

24 

(3) 




LABELS 

Address Labe 1 
• • 10 


FUNCTIONS ANO SUBROUTINES referenced 

AMAT MATAS 

Total Space Allocated * 1431 Bytes 


COMMAND qualifiers 

FORTRAN /LIST GC P, I NO ATA, MA TAB. OU T DA TA, RUNG, DN AV, EPH EM, TRU EA, SPR ESS, OCCULT.GPERT.GCPSEQ. VISIBLE. GENE NV.TREG.GVRQUT, RATE, BMAT , CMA 

/CHECK=(N0 BOUNDS .OVERFLOW) 

/DEBUG*! NO SYMBOL S , TRAC EBAC1 i 

/F77 / nog _ float ing /I4 /optimize /warnings /nod_lines /nomachine code /continuations-ib 


COMPILATION STATISTICS 


Run T i me : 

E 1 apsed T i me: 
Page Faults: 
Dynamic Memory: 


1 . 04 seconds 
13.93 seconds 
341 

160 pages 


2.3 Generate Environment (GENENV) 

The generate environment module (GENENV) is responsible for propagating 
the true vehicle navigation and attitude states and for generating the 
gyro output between measurements. The true vehicle state is used to gen- 
erate the measurements and for determining the error in the estimated state. 
The gyro output , which is processed by the executive through a call to 
GYRO, is used to propagate the vehicle attitude between measurements. 

GENENV is called by the executive module (GCP) . During the first call, 
GENENV is called by the true navigation state from present time up to 
measurement time using the real-world integrator, RUNG. This process is 
performed in small increments determined by the default integration inter- 
val DEL. 

During all subsequent calls, GENENV simply generates the gyro output 
over a specified sampling period, DTA, by calling GYROUT. Before exiting, 
GENENV updates the vehicle time word, TIME. 

A VCLR of GENENV is contained in Figure A-H . 


A-69 


GENERATE ENVIRONMENT GENENV 


FT 


New Measurement Sequence 


Compute normal integration time 
using a fixed step size (TISN) 



Compute integration step size (DT) 
as the minimum of TMEAS and 
TISN minus the time to which 
position has been integrated 


Integrate true vehicle state 
from TIS to TIS+DT 


Do until position is integrated to 
measurement time TIS=TMEAS 


Set old measurement sequence flag 


Compute total remaining gyro interval 

Compute gyro output interval (DTA) as the minimum 
of the remaining interval and normal sampling interval 


Generate Gyro output GYROUT 


Update attitude integrator time flag T1A 


Update atomic time flag 


/ 



Figure A-ll 


NULL 



6- Apr- 1 90 1 14:40:40 VAX-11 FORTRAN .2.0-2 

1 1 -Sep- 1 980 12:27:34 _DBA0 : [ D I 1 R . GC r> j GENENV . FOR : 6 


0001 



SUBROUTINE GENENV(FLAG) 


0002 



LOGICAL FLAG 


0003 



RE AL«0 

ogyro.dt .dstat 


00 04 



INCLUDE 'DEBUG.COM’ 


00100 

0005 

• 


COMMON /DEBUG/ I ENT el 

, .DEBUG 

00200 


• 

C 



00300 


• 

C 

USER CONTROL 

LED PARAMETERS TO VARY DEBUG PRINT LEVEL 

00400 


• 

C 



00500 


• 

C 

I ‘.'EL 

IF 1. PRINTS WHEN ENTERS MOST SUBROUTINES 

00600 


• 

C 

ICEBjG 

0-10, HIGHER NUMBER MEANS MORE PRINT 

00700 


• 

C 




0006 



INCLUDE 'TIME.COM' 


OC 1 00 


• 

c 



00200 

0007 

• 


COMMON /TIME/ TIME.TN 

E XT. TSTOP, TIA, DEL. TIN. DTN. OATEO.TZEPO 

00300 


• 


. TMEAS , 

TRACK . TIS. T I SN.DTA.DAT ER.TPRI NT .DTP PINT 

00400 

oooa 

• 


RE al*8 time.tnext.tstgp.tia.del.tin.dtn.dateo.tmeas.track.tis. 

00500 


• 


TISN.OTA.TZERO 

•DA TER, TPRINT, OTPRINT 

00600 


0 

c 



00700 


• 

c 

THESE ARE THE TIME REFERENCE FRAMES 

oceoo 


• 

c 



00900 


• 

c 

TIME 

ATOMIC TIME SINCE INITIALIZATION 1 SEC ) 

01000 


• 

c 

TNEAT 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

01100 


• 

c 

tstop 

RUN termination TIME (SEC) 

01200 


• 

c 

T IA 

ATTITUDE INTEGRATION TIME (SEC) 

01300 


• 

c 

D L 

- “ STEP SIZE (SEC) 

01400 


• 

c 

TIN 

POSITION INTEGRATION TIME (SEC) 

01500 


• 

c 

dtn 

" * STEP SIZE (SEC) 

01600 


• 

c 

dateo 

DATE of flight EPOCH (JD) 

01700 


• 

c 

dater 

DATE OF 1950 EPOCH ( UD 1 

01800 


• 

c 

T ZERO 

START TIME IN SECS. SINCE DATEO 

01900 


• 

c 

TSLEW 

TIME NEEDEO TO SLEW AND ACQUIRE tSEC) 

02000 


# 

c 

TIS 

REAL WORLO REFERENCE TIME (SEC) 

02100 


• 

c 

TISN 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 

02200 


• 

c 

OTA 

USUALLY + DEL BUT ♦ TSLEW - TIA WHEN DEL 

02300 


• 

c 


TOO LARGE AT MEASUREMENT TIME 

02400 


• 

c 

TPRINT 

TIME FOR PRINT (SEC) 

02500 


• 

c 

otprint 

INCREMENT ON TPRINT (SEC) 

02600 


• 

c 




0009 



INCLUDE 'TARG TS.COM' 


0010 

• 


COMMON /TARGETS/ MT Y PE . I S . NS , JF L AG ,MCODE , PI , T P I 


001 1 

• 


logical jflag 



0012 

• 

r 

realms p I , tpi 




• 

*- 

c 

MEASUR WENT 

SPECIFICATIONS 



• 

c 

c 

mtype 

MEASUREMENT TYPE 



• 

c 

jflag 

SET FOR STAR OBSTRUCTION 



m 

c 

MCGOE 

" MEASUREMENT PROCESSING 



m 

c 

PI 

PI 



• 

c 

r 

TPI 

2 * P I 


0013 


w 

INCLUDE 'ENVIR.COM' 



0014 

• 


COMMON /ENVIR/ STATE! 10} . P ROF I LE ( 1 0 , 4 ) ,INIT 


0015 

• 


REAL»8 STATE. PROFILE 



C 

C REAL WORLD STATE PARAMETERS 

C 


Page 


GENENV 


6 - Apr- 1 98 1 14:48:40 VAX-11 FORTRAN V2.0-2 
1 1 -Sep- 1 980 12:27:34 _DBA0: [ D 1 1 R. GCP ] GENENV . FOR : 6 



• 

C 

STATE 

STATE VALUES: X , Y , Z , XD . YD . ZD , EO . E 1 , E2 . E3 


• 

c 

PROFILE 

ATTITUDE PROFILE-TIME (SEC) VS 


• 

c 


INERTIAL ANGULAR RATES (RAD/SEC) 


• 

c 

INI T 

INTEGRATION INITIALIZATION KEY (-1) 

0016 



INCLUOE 'CONTRL.COM' 


0017 

• 


COMMON /CONTRL/ MOP. TINT 

0016 

• 


REAL'S TINT 



• 

c 

program control descriptors for multiple runs 


• 

c 

MOP 

MODE OF OPERATION 


• 

c 


1 = PRE F LIGHT SIMULATION 


• 

c 


2 * POSTFLIGHT SIMULATION 


• 

c 


3 « MONTE CARLO SIMULATION 


• 

c 

TINT NUMBER OF SEC0N0S OF FULL OPERATION PER CYCLE 

0019 



DIMENS ION DSTATEI 1 0 I 


0020 



IF(FLAG) GO TO 10 




c 

this is a new measurement 



c 

INTEGRATE TRU STATE 

TO MEASUREMENT time 

0021 


5 

CALL TREG(TIS.TISN) 

1 tisn»tis*dtu 

0022 



DT * MIN(TISN. TMEAS) 

-TIS 

0023 



IF(OT. GT. .01 ) CALL RUNG! INIT, STATE, OSTATE, TIS.OT ) 

0024 



I F ( T I S ♦ .01 .LT. TMEAS) GO TO 5 

0025 



FLAG * .TRUE . 




c 

GENERATE GYRO OUTPUT 


0026 


10 

DGYRO* TMEAS - TIA 

1 COMPUTE INTERVAL REMAINING 

0027 



OTA > MINIDE L.DGYRO) 

1 COMPUTE OUTPUT INCREMENT 

0028 



CALL GYROUT 

I GENERATE GYRO OUTPUT 

0029 



TIA'TIA ♦ DT A 

1 UPDATE GYRO TIME WORO 

0030 



TIME « TIA 


0031 



RETURN 


0032 



END 



P»0«» 


GENENV 


PROGRAM SECTIONS 


6 - Apr - 1 98 1 14:48:40 VAX-11 FORTRAN V2.0-2 Page 3 

1 1 -Sep- 1 980 12:27:34 _DBA0 : [ D 1 1 R . GCP ]GENENV . FOR ; 6 



Name 

Bytes 

At t r i butes 







0 

SCODE 

139 

PIC CON 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

2 

St GCAL 

1 32 

PIC CON 

REl 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 

3 

OE BUG 

8 

PIC GVR 

pel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

4 

T I ME 

1 36 

PIC OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

5 

TARGETS 

36 

PIC OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

6 

ENvIR 

404 

PIC OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

7 

CONTRL 

12 

PIC OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
O-OOOOOCOO GENENV 


VAR I AB [.ES 


Address 

T ype 

Name 

Address 

Type 

Name 

4-00 0000 38 

R • 8 

OATEO 

4-00000070 

R * 8 

dater 

2-00 000058 

R*8 

OT 

4-00000008 

R *8 

DT A 

AP-00 000004# 

L • 4 

F LAG 

3-00000004 

1 *4 

I DEBUG 

5-00 0000C4 

1*4 

IS 

5-OOCOOOOC 

L *4 

3 FLAG 

5-00 C000C0 

1*4 

MT YPE 

5-OOOCOOC8 

I *4 

NS 

4- r 000CC00 

R*8 

TIME 

4 -000 CC 0 28 

R»8 

TIN 

4-00000060 

R*8 

TISN 

4-00000048 

R • 8 

tmeas 

4-00000078 

R»8 

TPRINT 

4-00000050 

R *8 

track 


ARRAYS 

Address 

Type 

Name 

By t es 

D i mens i oni 

2-00000000 

R*8 

OSTATE 

80 

(10) 

6-00000050 

R»8 

PROFI LE 

320 

(10, 4) 

e-oooooooo 

R*8 

STATE 

80 

(10) 

LABELS 

Address 

Labe 1 

Address 

Labe 1 


0-00 Q0000D 

5 

0-0000 OOSD 

10 



FUNCTIONS AND SUBROUTINES REFERENCED 
GYROUT RUNG TREG 


Address 

T ype 

Name 

Address 

Type 

Name 

4-00000020 

R * 0 

DEL 

2 -OCOOO 050 

R • 8 

DGYRO 

4-00000030 

R*8 

DTN 

4-00000080 

R • 8 

DTPRINT 

3-00000000 

1*4 

IENTER 

6-00000 1 90 

I *4 

INIT 

5-00000010 

1*4 

MCODE 

7-00000000 

I *4 

MOP 

5-00000014 

R*8 

PI 

4-00000018 

R *8 

T I A 

7-00000004 

R*8 

TINT 

4-00000058 

R • 8 

TIS 

4-00000008 

R * 8 

TNEXT 

5-0000001C 

R *8 

TPI 

4-00000010 

R*8 

TSTOP 

4-00000040 

R *8 

T ZERO 




Total Space Allocated • BS7 Bytes 


1 


command qualifiers 

FORTRAN /LIST GCP.INDA 


6-Apr-19B1 14.48:40 VAX-11 FORTRAN V2.0-2 
1 1 -Sep- 1 980 12:27.34 _DBAO: 1 0 1 1 R . GC P JGENENV . FOR ; 6 

T A, MAT AB, OUT DATA. RUNG. ON AV.EPHEM.TRUEA.SPRESS. OCCULT. GPERT , GCPSEQ .VISIBLE. GENENV ,TREG. GY ROUT, RATE, BMAT , CMA 


/CHE CKs( NO BOUNDS .OVERFLOW) 

/?7? UG /NOG^LOATmr A /!r C /OPTIMIZE /WARNINGS /NOO.LINES /NOM ACHI NE.COOE /CONT I NUAT I ONS- 1 9 


COMPILATION STATISTICS 

Run Tim«: ' 
Elapsed Time: 1 
Page Faults: 2 
Dynamic Memory: I 


1.10 seconds 
19.39 seconds 
340 

160 pages 



2,3,1 integrate actual navigation STATE (RUNG) 

The position state is advanced in time by numerical integration of the 
equations of motion. The second order equations of motion are composed of the 
external forces acting on the spacecraft. The external forces consist of 
geopotential, lunar gravitation and solar gravitation and radiation pressure. 

A study showed that the Runge Kutta Gill (RKG) 4th order numerical 
in egrat ion method is optimal for this application, it is self-starting, 
handles variable step sices, and is sufficiently accurate. 

The Runge Kutta Gill (RKG) method for numerically integrating differential 
equations is described here. 

calculated^y 6 “ *** V * 1Ue ° f *** function durin 8 the computing interval is 


where 


Ay 


+ 2(l-k)K 2 + 2 ( 1+k ) k 3 + k 4 > 


k'i = h-f(t n ,y n ) k = /l/2 

<2 = h* f (t n + ^h, y n + ^K!*) 

<3 = h-f(t n + »sh, y n +(-h + k) k j +(l-k)K 2 ) 

K 4 = h • f ( t n + h, y n - k< 2 +(l+k)(C 3 ) 
h = computing interval (seconds) 

t n = time of beginning of computing interval (seconds) 

y n “ value o £• function at beginning of computing interval 

The derivative function f shall be evaluated four times to calculate the 
change in the function being integrated during the computing interval. 

At first appearance, the software algorithm has no relation to the 

d,BC ? i P ti ° n ° f the integrator. The following is intended to show 
Chat the two are indeed identical. 

result thrOU8h tbe outer do lo °P for K - 1 to 4 we find the following 

K = 1 f = y n ) 

ti = hf 

yi = yo + *sdtf 
qi = f 


k = 2 


f' = f (t n + ^ , y 0 + 


t 2 - (1 -’fxf'- f) 

Y2 = yo + + dtci -*y)(f'- f) 

* y 0 + dt(-4 +*|)f + dt (1 
q 2 - f + 3 (1 f) -(1 

- f - 3(1 -*|)f + 2(1 -*|)f' 


A-75 


K • 3 


f" - f(t n + dt, y + dt(-2 +/?)f + dt(l f' 

2 2 2 2 

t 3 - (1 +/2)(f" - f + 3(1 -/2)f - 2(1 -/f)f') 

2 2 2 

y 3 - y 0 + dt(-l +/2)f + dt(l -fi) f' + dt ( 1 +/2)(f"- f + 3(1 -/2)f 
2 2 2 2 2 

-2(1 -/2)f ') 

2 

- y 0 - dt/2f' + dt(l +*f)f" 

2 2 

q 3 - f - 3(1 -/|)f + 2(1 -/£)f’ + 3 ( ( 1 +/2){f"-f + 3(1 -S[)l - 2(1 -/2)f'} 

2 2 2 2 2 

-(1 +/2)f") 

2 

- -J. f - ( 1 +vf)f'+ 2(1 +/2)f" 

2 2 2 

K « 4 f"' - f(t n + dt, y 0 - dt/2f' + dt(l +/2)f") 

2 2 

t 4 - _l(f'"- 2 - If -(1 -iV2)f' + 2(1 +/2)f") 

6 2 2 2 

- J_(f'"+ f + 2(1 +/2)f' - 4(1 +/2)f") 

6 2 2 

y 4 - y 0 - dt/2f' f dt(l +/2)f"+ _l(dtf + 2dt(l +/2)f'- 4dt(l +/2)f"+ dtf'" 
2 2 6 2 2 

- y 0 - _1 (dtf + 2dt(l -/2)f' + 2dt(l +/2)f"+ dtf'") 

6 2 2 

Making the substitutions 
Kj - dtf 

k 2 - dtf k m71 

K 3 - dtf" 2 

K 4 * dtf' ' ' 

Yields 

y - y 0 = Ay - HKj + 2(1 - k)K 2 + 2(1 + k)K 3 + K 4 } 

6 

which is identical to the original algorithm. 


A-76 


RUNG VCLR 


INITIAL ENTRY 


NULL Q MATRIX 


NULL 


COMPUTE POSITION DYNAMICS 


K = 1 OR 3 


T = T + DT/2 


NULL 


TP = AA (K) * ( ZD ( I ) - BB (K) * Q { I ) ) 


W = Z(I) 


Z(I) = Z ( I ) + TP * DT 


TP = C' (I) - W) /DT 


Q (I) = Q ( I ) + 3*T - CC (K) * ZD ( I ) 

Where AA = .5, 1-/2/2, 1 + /2/2 , .5/3 BB = 2 ,1,1,2 
CC = .5, 1- /I/2, 1 + v'1/2, .5 

DO UNTIL 1=6 


DO UNTIL K = 4 




6-Api — 1981 14:46:01 

1 9-Sep- 1 900 09:10:59 


VAX-11 FORTRAN 72.0-3 
_0BA0: 101 1R.GCR ’.RUNG. FOR: 7 


ooioo 

0001 


00200 


C* •• 

0l300 


c 

00400 


c 

0C600 


c 

OC600 


c 

00700 


c- •• 

00800 

0002 


OOIOO 

0003 

• 

00200 


• c 

CO 300 


• c 

0C400 


• c 

0 0500 


• c 

OCbOO 


• c 

00700 


• c 

00900 

0004 


01000 

0005 


01100 

0006 


01200 

0007 


01300 

0008 


01400 

0009 


01500 


c* • 

01600 


c 

01700 


c* • 

01800 

0010 


01900 

001 1 

10 

02000 


c- • 

02100 


c 

02200 


c- • 

02300 

0012 


02400 

0013 


02500 

0014 


03G00 


c» » 

02700 


c 

02800 


c- < 

02900 

0015 


03000 

0016 


03100 

0017 


03200 

0018 


03300 

0019 

30 

03400 

0020 


03500 

0021 



SUBROUTINE RUNG! INIT .Z.ZD.TI.DT) 


THIS ROUTINE INTEGRATES THE SIX REAL WORLD NAVIGATION 
STATES FROM TIME T1 TO TI ♦ OTU USING A RUNGE KUTTA GILL 
FORMULATION. STATE PARUALS.ZO . ARE GENERATED BY DNAV 
AND INTEGRATED TO FORM Z. ........ 


INCLUDE 'DEBUG.COM' 

COMMON /DEBUG/ I EN T E R . I DEBUG 


USER CONTROLLED PARAMETERS TO vary DEBUG PRINT LEVEL 


I N i E R 
I OE BUG 


IF 1 PRINTS WHEN ENTERS MOST SUBROUTINES 
0-10. HIGHER NUMBER MEANS MORE PRINT 


DIMENSION 2(6) . ZOI 6 ) 

DIMENSION AA(4 ) .BB' 4 ) ,CC(4 ) .0(7) 

REAL'S DT.T.TI .AA.B9.CC.Q.Z.ZD 

OATA AA /.5.. 292893.1-707107. .1666667/ 
DATA BB /2. .1..1-.2./ 

DATA CC /. 5. .292893. 1.707107. .5/ 


INITIALIZE 0 ARRAY 


DO 10 I«1.6 

0(1) « o. 

COMPUTE FOUR TERMS OF RUNGE KUTTA INTEGRATOR^ ^ 

00 CAL L*DNAV ( T I . Z . ZO, IDUMFSf ) ! COMPUTE POS. DYNAMIC PART I ALS 
IF(K.60.1 .OR.R.E0.3S TI * TI ♦ DT/2. 

INTEGRATE SIX NAVIGATION STATES ,,,.»**•••••••••••••* 

DO 30 1-1.6 

T - *A(K)MZD(I)-BB(K).0(I)) 

2(1) ■ Z( 1 ) ♦T-OT 

0(1) • Q( I )O.*T-CC(K)-Z0(t) 

CONTINUE 

RETURN 

END 


RUNG 


PROGRAM SECTIONS 


Name 

0 scoot 

2 SLOCAL 

3 DEBUG 


6-Ap--1981 14:46:01 VAX-11 FORTRAN V2.0-2 

19-Sep-1980 09:10:59 _D8A0: [D1 1fl.GCP]»UNG. FOR: 7 


Bytes Attributes 


169 PIC CON REl LCL SHR EXE 

232 PIC CON REL LCL NOSHR NOEXE 

B PIC OVR REL GBL SHR NOEXE 


RD NOWRT LONG 
RO WRT OU AO 
RO WRT LONG 


ENTRY POINTS 

Add-ess Type Name 

0-00 000000 RUNG 


VARIABl ES 

Add~es » Tyoa Nam* 

AP-00 0000 I 4# R*8 DT 
3-00000000 1*4 I ENTER 

AP-00 0000 1 0# R»B T I 


Address Type Nam* 


2-OGOOQOAO 1*4 
A P -0000 00 04* I»4 


INIT 


ARRAYS 


2-00 000000 
2-00000020 
2-00000040 
2-00000060 


Type 

Nam* 

Bytes 

D i mansions 

R»8 

AA 

32 

(4 ) 

R»8 

BB 

32 

(4) 

R*8 

CC 

32 

(4 ) 

R*8 

0 

56 

(7) 

R*B 

z 

4C 

(6) 

R*8 

ZD 

48 

16) 


LABELS 

Address 


Lab* I 
10 


Address 


Labe 1 
30 


FUNCTIONS ANO SUBROUTINES REF- EWCEO 
ONAV 


Address Type Name 


Address Type Name 


3-00000004 

2-OOOOOOA4 


1*4 

1*4 


IDE BUG 
K 


2-OOCOOOA8 

2-00000098 


1*4 

R»8 


I dummy 
t 


Pag* 2 


Total Space Allocated ■ 409 Bytes 


on- 



— 'V 


* ' 'V. » 



6-Apr-1981 14:46:01 VAX-11 FORTRAN V2.0-2 Page 3 

19-Sep-1 980 09:10:59 _DBAO: [D1 IR.GCPlRUNG. FOR: 7 


COMMAND OUAL IFIERS 

FORTRAN LIST GCP. INOAT A .MAT AB .OUT DAT A . RUNG . ON AV . EPHEM, TRUEA , SPRESS , OCCULT . CPERT . GCPSEQ . V ISI BLE .GENEMV . TREG.GVROUT . RAT E .8MAT ,CMA 

/CHECK. (NOBOUNDS .OVERFLOW) 

/DEBUG. I NOSYMBOL S. TRACEBACK ) 

/F77 /NOG FLOATING /I4 /OPTIMIZE /WARNINGS /MOO. LINES /NOMACHINE COOE /CONT 1NUAT10NS-19 


COMPILATION STATISTICS 


Cun Tim*: 

E ■ ipted T i m« : 
Paga Faults: 
Dynamic Memory : 


1 . 02 seconds 
13.59 seconds 
332 

160 pages 


1 

i 



1 


L-j 


cufiaiaiaifllll 


2.3.1. 1 SPECIFY INTEGRATION STEP SIZE (TREG) 


This module generates the endpoint of the integration period using the 
default intervel DTV. 



SPECIFY INTEGRATION STEP 


COMPUTE MAXIMUM TIME FOR NEXT 
POSITION INTEGRATION 

TNEXT * TIME + DTV 


Figure A- 13 



i . -Mr- 


6-Aor-1981 14:99:00 VAX-11 FORT R 2.0-2 Pa « e 

1 1 -Sep- 1 980 11 : 58 : 50 _DBA0:[D11R 1REG.FCR;3 


0001 

0002 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


0003 


SU3R OUT INE TREG( T IME . T N XT) 

INCLUDE 'DE8UG.COM 1 

• COMMON /DEBUG/ IEVET, i DEBUG 

. Q USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

* c I NTER IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 

, r IOEBJG 0-10, HIGHER NUMBER MEANS MORE PRINT 


0004 

0005 


C 


0006 


0007 

0008 
0009 


0010 
001 1 
0312 
0013 


C 

c 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


INCLUDE 'RVEC.COM' 

COMMON /RVEC/ R I 3 ) . RM> 3) . RO( 3) . RSM( 3) , RSO( 3 ) . RSS( 3 ) , S8( 3 ) 

, R A . P 2 , R 3 . R SM A , R I G ( 3 ) 

REAL'S R , RM, RO , RSM. RbC .RSS , S0.RA , R2.R3 , RSMA , RTG 

THESE ARE RADIUS VECTORS IN EC1 AND BODY COORDINATES 
R EARTH CENTER TO S/C - EC I (KM) 


RM 

« ■ MOON 

- EC I 

(KM) 

RQ 

- * SUN - 

EC I 

(KM) 

R$M 

SPACECRAFT TO MOON - 


EC I (KM) 

rso 

« SUN - 


EC I (KM) 

RSS 

EARTH CENTER TO STAR 

- EC1 


RA 

ABSOLUTE OF VECTOR R 

(KM) 


R2 

SQUARE OF RA (KM 2) 



R3 

CUBE OF RA (KM 3) 



R3MA 

ABSOLUTE OF RSM (KM) 




INCLUDE 'CONST.COM 1 

COMMON /CONST/ AIM . RBM, RBE . RBO ,’E2 , RM2 , UM , US ,UE,J2 ,J3,J4 .DTU.PK1 
REALMS ATM. PBM.RBE .RPO. 1 c2 ,RM2 , UM , US , UE , U2 , J3 , J4 , DTU . PK1 


PROGRAM CONSTANTS 


ATM 

R8M 

RBE 

RBO 

R 2 

RM2 

CM 

US 

u . 

U2.J3.J4 

OTU 

PKI 


S/C AREA TO MASS RATIO (METERS/KG) 
OBSTRUCTION RADIUS OF THE MOON (KM) 

- < EARTH (KM) 

■ ■ SUN (KM) 

SQUARE OF THE EARTHS .RADIUS (KM 2) 

- LUNAR RADIUS (KM 2) 

LUNAR GRAVITATION CONSTANT (KM 3/SEC 2) 
SOLAR * 

EARTH * * 

ZONAL GRAVITATIONAL HARMONIC TERMS 
REGULARIZED TIME STEP SIZE (SEC) 

SOLAR PRESSURE CONSTANT 


COMPUTE REGULARIZED TIME INTERVAL 
REAL'S TIME.TNEXT 
TNEXT • TIME ♦ DTU 
RETURN 
END 


v8”V 


TREG 


6-Apr-1981 14:49:00 
1 1 -Sep-1 980 1 1 : 58 : 50 


VAX-11 FORTRAN V2.0-3 
_0BA0: [01 1 R . GC P ] TREG. FOR 1 3 


Page 2 


PROGRAM sections 


Name 


0 SCOOE 

3 DEBUG 

4 RV EC 

5 CONST 


Bytes Attributes 

13 PIC CON REL LCL SHR EXE 

8 "IC OVR REL G 8 L SHR NOEXE 

224 PIC OVR REL GBL SHR NOEXE 

112 PIC OVR REL GBL SHR NOEXE 


RD NOWRT LONG 
RO WRT LONG 
RD WRT LONG 
RO WRT LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 TREG 


VARIABLES 


Address 

Type 

Name 

5-00000000 

R *8 

ATM 

5-00000048 

R «8 

J 2 

4-00 OOOOBO 

R*:' 

R2 

5-00000008 

R *8 

RBM 

4-00 OOOOCO 

R *8 

RSM A 

5-00000030 

R *8 

UM 


Address 

T ype 

Name 

5-00000060 

R *8 

OTU 

5-00000050 

R *8 

03 

4-C000S0B8 

R *8 

R3 

5-00000018 

R *8 

RBO 

ap - ooooooo4e 

R *8 

TIME 

5-00000038 

R*0 

US 


Address T 

ype 

Name 

3-00000004 

1*4 

I DEBUG 

5-00000058 

R *8 

J4 

4-000000A8 

R *8 

RA 

5-00000020 

R *8 

RE2 

AP-00 000008? 

R *8 

TNEXT 


Address 

Type 

Name 

3-00000000 

1*4 

I ENTER 

5-00000068 

R * 8 

PK 1 

5-00000010 

R *8 

RBE 

5-00000028 

R *8 

RM2 

5-00000040 

R*B 

UE 


ARRAYS 

Address Type Name 


Bytes Oi mens 1on» 


4-00000000 
4-00000018 
4-00 000030 
4-00000040 
4-00000060 
4-0001)0078 
4-00 OOOOCB 
4-00000090 


R *8 R 
R*B RM 
R *8 RO 
R *8 RSM 
R *8 RSO 
R *8 RSS 
R*P, RTG 
R *8 SB 


24 

(3) 

24 

(3) 

24 

13) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 


Total Space Allocated « 357 Bytes 


COMMAND QUALIFIERS 

FORTRAN /LIST GCP, INDATA, MAT AB, OUT DATA , RUNG, DNAV 


EPHEM.TRUEA.SPRESS, OCCULT, GPERT .gcpseo.v 


ISIBLE .GENENV.TR EG. GYROUT .RATE .BMAT ,CMA 


/CHE CKM NO BOUNDS .OVERFLOW) 

/OEBUG= ( N0SYM80L S . TRACEBACK) 

/F77 /NOG_FLOA T ING /I4 /OPTIMIZE 


WARNINGS /NOD.LIMES /NOMACHINE.CODE /CONTINUATlONS-19 






TREG 


6-Apr- 1 98 1 14:49:00 VAX-11 FORTRAN V2.0-2 •'•O® 3 

1 1 -Sep-1 980 11:58:50 _DBA0: [ D 1 1 R .GCP ] TREG . FOR : 3 


COMPILATION STATISTICS 


Run T 1 me I 

E 1 apsed 'Iim: 
Tag* Faults'- 
Dynamic Memory: 


0.66 second* 
12-52 second* 
27 1 

160 pages 


2. 3. 1.2 COMPUTE POSITION DYNAMICS (DNAV) 

This module computes the forces acting on the spacecraft and generates the 
differential equation to be integrated by the state propagator. 

The position of the spacecraft is calculated by solving three 
simultaneous, second order differential equations: 

X! - -xi* ^ 3 + gi(t.x) + a^t.x) 

*2 " -*2' r3 + 82 (t.x) + a 2 (t,x) 
x 3 ■ ~x 3 * “3+ g3(t» x ) + a 3^ c » x ^ 


where 


X - |xi, x 2 , X 3 | 3, 2\ 

„ . Earth gravity constant (3.985491209E + 05 Km /sec 2 ) 

R - <X! 2 + X 2 2 + XJ 2 )^ 

X 1 » x 2 » x 3 = Coordinate of spacecraft 

„ = Accelerations caused by zonal harmonia of earth gravity 

Si * 82 9 8 3 

a a = solar radiation pressure perturbations, sun and moon gravity 


The zonal harmonic accelerations are computed by: 

81 “ -V fV F 1 


X2 - 

82 " "I* F 1 


83 


u X3 
" x 7 R 


Fi -F 2 


where 


and 


F, - £ 2 J 2 + <f )3 - £ 3 J2+ ^ 

F, . I(^) 2 - £,J 2 + tf> 3 ‘ W (K' f3j4 

f B _ 3 *a 

f l “ J R 

f 2 - -7.5(f) ? + 1-5 

t, . -17.5(f)’ + 

- -39.375(f)"+ 26.25(f) - 1-875 


j 2 . 1082. 7E -6 (Harmonic term in earth gravity model) 
j, . -2.56E -6 (Harmonic ter. in earth gravity model) 
j . -1.58E -6 (Harmonic term in earth gravity model) 


A- 8 6 


WWjy Wt • - AT* 






i 


The process ehovm in Figure A-l^ requ ired to compute the 

corresponding to current txnm ' h locetione of the sun, roon, end 

eoler end luner epheoerides. ^J d to eech of the.e bodies. These 

The se° forces ere 

order dUf.re.ti.1 e,u.tio.e of ->cion 

previously discussed. 


A-87 
















00100 
00200 
Ol 300 
00400 
00500 
OOIOO 

0001 

0002 

0003 

0004 

0005 

0006 



00200 



C 

0 n 309 



c 

00400 



c 

O'" 600 



c 

0 0600 



c 

00700 



c 

0 0600 

00 100 

0007 


c 

00 200 

0008 



O : 300 
0 0400 

0009 



00600 

00600 



c 

00700 



c 

00800 



c 

0:900 



c 

01000 



c 

01100 



c 

01200 



c 

01300 



c 

01400 



c 

0 500 



c 

0 1 600 



c 

0 ' 7C0 



c 

0 1 BOO 



c 

01900 



c 

07000 



c 

32100 



c 

02200 



c 

02 300 



c 

07400 



c 

C2S00 



c 

02600 



c 

00700 
O' 800 

0010 
001 1 



00800 

0012 



00800 



c 

00800 



c 

OC 900 



c 

OCBOO 



c 

00800 



c 

OC 8C0 



c 

00800 



c 

OCSOO 



c 

00800 



c 

0 0 900 



c 

00800 



c 

00800 



c 

00800 



c 

OOBOO 



c 

ooaco 



r* 
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subroutine onavi t . < . *d. icalu 

DIMENSION X ( 6 ) . XDl b , , A'jP ( 3 ) , AS LG ( 3 ) 

REAL’S X , XD, ASP . AS _G . 1 . F2 . T2 . OAT E , F3, F4 FI , RER , RER2 T1.74 ZR2 

REAL’S vMAG 

INCLUDE ’ OESUG . CCV1 

COMMON /DEBUG/ I EN • E R . . D6 BUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

I NtER IT 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
I0E6UG 0-10, HIGHER NUMBER MEANS MORE PRINT 

incluoe 'time.com' 


COMMON /TIME/ TIVL. 'NEXT. TSTOP, TIA.DEL, TIN. DIN, DATEO.TZERO 

, TVE '.3 , TRACK . TIS, T 1SN. DTA.DATER. TPRI NT.DTPRINT 
RE A L*8 T IME, TNEx t . I S TCP , T I A , DEL , TIN. OTN. DATEO , TME AS , TRACK . T I S . 
T ISN, OT A . TZtRO . DATE R, TPR INT ,DTPR INT 

these are the time reference frames 


TIME 
TNFX T 
TSTQP 
T I A 
0 L 
T IN 
OTN 
OATEO 

cater 

tzero 

tSlE«( 

TIS 

TISN 

0 T A 

TPRINT 

OTPRInT 


ATOMIC TIME SINCE INITIALIZATION I SEC ) 

TIME for NEXT POSITION INTEGRATION (SEC) 
RIJN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

* STEP SUE (SEC) 

POSITION INTEGRATION TIME (SEC) 

STEP SIZE (SEC) 

CATC OF FLIGHT EPOCH (JD) 

DATE OF 1950 EPOCH (U0( 

START TIME IN SECS. SINCE OATEO 

time needed to slew AND ACQUIRE (SEC* 

REAL WORLD REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY ♦ DEL BUT + T SLEW - TIA WHEM DEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


INCLUOE 'CONST.COM 

COMMON /CONST/ ATM.R8M.R3E . RBO . R E 2 . RM2 . UM . US , UE , U2 U3 J4 OTU PK1 
REAL * 0 ATM.R5M.R8E . RBO , R E2 , RM2 , UM , US , UE . U2 , J3 , J4 ' DTU ! P K1 


PROGRAM CONSTANTS 


ATM 

RBM 

R BE 

RBO 

R 2 

RM2 

UM 

US 

U 

U2. J3. J4 

DTU 

PKI 


S/C AREA TO MASS RATIO ( ME T ERS/KG 1 
OBSTRUCTION RADIUS OF TME MOON (KM) 

EARTH (KM) 

SUN (KM ) 

SQUARE OF THE EARTHS RADIUS (KM 2) 

" LUNAR RADIUS (KM 2) 

LUNAR GRAVITATION CONSTANT (KM 3/SEC 2) 
SOLAR ■ 

EARTH ■ 

ZONAL GRAVITATIONAL HARMONIC TERMS 
REGULARIZED TIME STEP SIZE (SEC) 

SOLAR PRESSURE CONSTANT 


DNAV 


6-Apr-1981 14:46:16 
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VAX-11 FORTRAN V2.0-2 
_0BA0: [Oil R .GCP 1DNAV • FOR : 9 


Pag* 2 


00800 

00800 

00900 

0C900 

00900 

00900 

00900 

0C900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 

00900 


0013 

0014 

0015 • 


C 

c 
c 
c 
c 
c 
c 
c 
c 
c 
' c 
I c 

• c 

• c 
c 


C0MM0N E /RVEC/ R( -3 1 .«■*' 3) .R0(3) ,RSM(3) .RSO(3) ,R5S(3) ,SB(3) 

, RA , R2 ,R3. RSMA. R . u( 3) 

* REAL*8 R, RM.RO. RSM.RbO.RSS. SB, RA.R2.R3,RSMA.RTG 

THESE ARE RA01US VECTORS IN ECI AND BOOT COORDINATES 

EARTH CENTER TO S/C - ECI (KM) 

- • MOON " ECI (KM) 

SUN - ECI (KM) 

SPACECRAFT TO MOON - 

. SUN - ECI (KM) 

EARTH CENTER TO STAR - ECI 
ABSOLUTE OF VECTOR R (KM) 

SQUARE OF RA (KM 2) 

CUBE OF RA (KM 3) 

ABSOLUTE OF RSM (KM) 


R 

RM 

RO 

R c 

R 

R 

R 

R t 
R3 
RSMA 


| COMPUTE JULIAN DATE 


01000 

0016 

01 100 


01200 

0017 

01300 

0018 

01400 


01600 


01600 


01700 

0019 

01300 

0020 

01900 

0021 

02000 

0022 

02100 

0023 

02200 

002 4 

02300 

0025 

02400 


07500 


02600 


02.00 

0026 

O2B00 


02900 

0027 

03000 

0028 

03100 


037^0 


03300 


03400 


03500 

0029 

03600 


03700 

0030 

03800 

0031 

03900 


04000 


04100 


04200 

0032 

04300 

0033 

04400 

0034 

04500 

0035 

04600 

0036 




COMPUTE JULIAN DAT 

DATE * DATEO-M T-TZERO ) /86400 . 

c COMPUTE SOLAR AND LUNAR EPHEMERIS 

CALL EPHEM(DATE.RM.RO) 

i Ecrc^omiurorvc*;;;: 



R ( I ) * -X(I) 

RSO(I) * RO(I).Rd) 

10 RSM(I) * RM(l).RU) 

RA * VMAG( R .3) 

R2 * R A * RA 
R3 > RA * R2 

RSMA * VMAG( RSM , 3 ) ************ **••••**♦***♦•••*••**•* 

* 

C SOLAR PRESSURE COMPUTATIONS .«.«*•*•••*•*••••**»»»*•••••••••••• 

* 

c -^mRSt'tIME^RITE SOLAR PRESSURE AT TIME T 

3E22.14) .«.»»********••***..*•......*.**.•*.•*••**** 

I SOLAR* LUN AR*GR A V 1 T AT l ON A L PERTURBATIONS 

* 

^FIRST^l^WRUE GRAVITATIONAL PERTURBATIONS 

” IF •' ’DEBUG .GT . 3) WRITE(6,996) TIN.ASLG . F7 , 3E22 14) 

996 FORMAT, 4X.‘ ACC. OUE TO MOON AND SUN . ’M i I il”i Ml . * . ..... 



q GEOPOTENTIAL - 4 ZONAL HARMONICS^ ,*,,**«*«****•**♦*••• 

ZR * X(3)/RA 

ZR2 » ZR*ZR 

FI » -3. »ZR 

FJ « 7 . 5*ZR2. 1 .5 

F3 • ZR* (7-5-1 7.5*ZR2) 


Pag* 3 


ON A V 




6-Apr-1 981 

14:46:16 VAX-11 





3-Apr-1 981 

09:43:22 _D8A0:[ 

04700 

0037 


F 4 • 

ZR2M26. 25-39. 375»ZR2)-1 .875 


04800 

0038 


REP * 

RBE/RA 


04900 

0039 


RE R2 

* RER*RER 


05000 

0040 


T 1 « 

RER2»(F2*J2+PER»( F3* J3*RER« ( F4»J4 ) ) ) 


05100 

0041 


T 2 * 

PER 2* ( FI • J2*RER* ( F2* J3+RER- ( F3»J4 ) ) ) 


05200 


c* •• 




05300 


C 

COMPUTE STATE PART IALS 


05400 


c* •• 




05500 

0042 


xo( 1 1 

- X<4) , x 

VE LOCI T Y 

05600 

0043 


XD<2| 

- X ( 5 ) | y 

VELOCITY 

05700 

0044 


X0(3) 

* X(6) | Z 

VELOCITY 

05800 

05900 

0045 


X0(4) 

* -UE«X( 1 )/R3«; I 1 + 1 . )+ASP( 1 )*ASLG(1 ) ! X 

ACCELERATION 

06000 

0046 


XD ( 5 ) 

* -UE»X( 2 )/R3* ( T1 + 1 . )+ASP(2)+ASLG(2) ! Y 

ACCELERATION 

Ob 100 

0047 


XD(6> 

* “UE/R2*(ZR*( T 1+1 . )-T2)+ASP(3)+ASLG( 3) 1 Z 

ACCELERATION 

06200 

0048 


IF UOEBUG .01. 31 WRITE(C,995) T IN . XD ( 4 ) . XD ( 5 1 , XD I 6 ) 


06300 

0049 

995 

FORMAT ( 4 X , ' TOTAL ACCELERATION AT TIME * , F7 . 1 . 1 8X . 3E22 . 1 4 1 

06400 

0050 


IF ( IDEBUG.GT. 1 ) KB I T E ( 6 . 994 ) { X ( 1 ) , I - 1 . 3 ) . R 


06500 

0051 

994 

FORMAT!/, ' AT ENO OF ONAV , POSITION VECTOR 3 ( 1 X , E20 . 1 0 )./ . 

06600 



c • 

AT END OF ON A V . SS TO EARTH * . 3( 1 X . E20 . 1 0 )) 


06700 

0052 


RETURN 


06800 

0053 


ENO 




PROGRAM SECTIONS 













Nime 



By t es 

At tr i butes 








0 SC ODE 



736 

PIC 

CON 

REL 

LCL 

SHR EXE 

RD NONRT LONG 




1 SPDATA 



255 

PIC 

CON 

rel 

LCL 

SHR NOEXE 

RD NONRT ^ONG 




2 SLOCAL 



288 

PIC 

CON 

REl 

LCL 

NOSHR NOEXE 

RD 

NRT QUAD 




3 CEBUG 



a 

PIC 

OVR 

REL 

GBL 

SHR NOEXE 

RD 

NRT LO'J 




4 TIME 



136 

PIC 

OVR 

REL 

GBL 

SHR NOEXE 

RD 

NRT LG 




5 CONST 



1 12 

PIC 

OVR 

REL 

GBL 

SHR NOEXE 

RO 

NRT LONG 




6 RV C C 



224 

PIC 

CVR 

REL 

G8L 

SHR NOEXE 

RD 

NRT LQ55 




ENTRY POINTS 














Address 

Typ* 

Nam* 












0-00000000 


DNAV 












VARIABLES 














Address 

Type 

Name 

Address Type 

Njm* 



Address 

Type 

Nam* 

Address 

Type 

Name 

5-00000000 

R«8 

ATM 

2-00000040 

R*0 

DATE 



4-00000038 

R*8 

DATEO 

4-00000070 

R * 8 

DA TER 

4-00000020 

R»8 

DEL 

4-00000068 

R*8 

OTA 



4-00000030 

R«8 

DTN 

4-00000080 

R *8 

OT PRINT 

5-00000060 

R»8 

DTU 

2-00000058 

R *8 

FI 



2-00000030 

R*8 

F2 

2-C000G048 

R *8 

F 3 

2-00000050 

R*8 

F4 

2-00000088 

1 *4 

1 



AP-00 0000 1 0P 

1*4 

ICALL 

3-00000004 

I *4 

I DEBUG 

3-00000000 

1*4 

I ENTER 

5-00000048 

R*e 

02 



5-00000050 

R»0 

J3 

5-00000058 

R * 8 

J4 

5-00000°68 

R*8 

PKt 

6-0000008(1 

R»8 

R2 



6-OOOOOOB9 

R»8 

R3 

6-OOOOOOA8 

R * 8 

RA 

5—00 OOOC 1 0 

R*8 

RBE 

5-00000008 

R»8 

RBM 



5-00000018 

R*8 

RBO 

5-00000020 

R *6 

RE 2 


I 

vC 

ho 


DNAV 






6-Apr— 1981 14: 

46: 16 

VAX-11 

FORTRAN V2.0-2 









3-Apr-t get 09: 

: 43 = 22 

_DBA0: 

[ D 1 1R.GCP JDNAV. FOR 

: 9 


2-00000060 

R*8 

RER 

2-00000068 

R * 8 

RER2 

5-00000028 

R»8 

RM2 

6-OOOOOOCO 

R • 8 

RSMA 

AP-00 000004* 

r*b 

T 

2-00000070 

R*8 

T 1 

2-00000038 

R*8 

T 2 

4-00000018 

R*8 

T I A 

4-00000000 

R*8 

TIME 

4-00000028 

R • 8 

TIN 

4-00000058 

R*8 

TIS 

4-00000060 

R • 8 

T1SN 

4-00 00004B 

R*i» 

TMEAS 

4-00000008 

R *8 

TNEXT 

4-00000078 

R*8 

TPRINT 

4-00000050 

R*B 

TRACK 

4-00000010 

R*a 

T STOP 

4-00000040 

R*8 

TZERO 

5-00000040 

R*8 

UE 

5-00000030 

R * 8 

UM 

5-00000038 

R*8 

US 

2-00000078 

R*8 

ZR 

2-00000080 

3*8 

ZR2 





ARRAYS 

Address Type 

Name 

Bytes 

Dimensions 

2-00000018 

R*8 

ASLG 

24 

(3) 

2-00 000000 

R*8 

ASP 

24 

i 3 ) 

6-00000000 

R»8 

R 

24 

( 3 ) 

6-00000018 

R*8 

RM 

24 

(3) 

6-00000030 

R*8 

RO 

24 

( 3 ) 

6-00 000048 

R*8 

RSM 

24 

(3) 

6-00 000060 

R«B 

RSO 

24 

(3) 

6-00000078 

R*8 

RSS 

24 

(3) 

6-0000O0C8 

R*8 

RTG 

24 

(3) 

6-00 000090 

R*8 

SB 

24 

(3) 

AP-00 000008* 

R«8 

X 

48 

(6) 

AP-00 00000C* 

R*8 

xo 

48 

(6) 


LABELS 










Address 

Labe 1 

Address 

Label 

Address 

Label 

Address 

Label 

Address 

Label 

• • 

10 

1-00000098 

994 * 

1- Of 000060 

995' 

1-0000003C 

996' 

1-00000000 

998' 


FUNCTIONS and subroutines referenced 

FRHEN GPERT SPRESS VMAG 


Total Space Allocated • 1759 Bytes 


COMMAND qualifiers 

FORTRAN /LIST GC P , INOAT A .MAT AS .OUT DATA , RUNG . LNA V .EPriEM, TRUEA ,S PRESS , OCCULT .GPERT , GCPSEQ. VIS1 BLE .GENE MV . T REG , GY ROUT .RATE. BMAT , CMA 

/CHECK* ( NO BOUNDS , OVERFLOW) 

/DEBUG* ( NO SYMBOL S , TRAC EBACK ) 

/F77 /NOG FLOATING /I4 /OPTIMIZE /WARNINGS /NOD.LtNES /NOMACHINE.CODE /CONT INUATIONS-19 


COMPILATION statistics 


Run Time: 
Elapsed Time: 
Page Fau its: 
Dynamic Memory: 


2.63 seconds 
34.97 stconds 
407 

160 pages 


2.3.2 GENERATE GYRO OUTPUT (GYROUT) 


The spacecraft attitude ia determined from a tabular input of the S/C 
Euler angle ratea aa a function of time. Thia tabulation ia called an 
attitude rate profile array. The gyro errora must be added to attitude ratea 
calculated from the attitude rate profile to make these data realistic. Since 
the gyro drift effects are accumulative the gyro attitude diverges 
significantly from the profile attitude permitting only the determination of 
gyro updates to an accumulated gyro state. 

The gyro drift error is accumulative and causes the output data to 
drift from the nominal attitude profile. To accommodate this drift effect a 
gyro attitude state is maintained and updated with the attitude profile. This 
effect is illustrated below. 


_ Gyro Rate 
— Rate Profile Table 


t - Flight time 

Procedure: 

1. Find the attitude rate from the profile table at time Tj. 

2. Compute the change in rate since previous time. 

3. Update the gyro rate and multiply the new rate by the scale 
factor bias error and then add a drift bias error 

W = SF be -(W 0 + AW) + Wdbe 

4. Account for the rcndom errors 

W'= SF re W + Wd re 

5. Compute the incremental gyro output data 

AW'* (Wf - W5)/DT 

6. Add random error to the gyro misalignment term. 

7. Transform to output frame. 



A- 4 3 


GENERATE GYRO OUTPUT MODULE 



A-94 
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00100 

00200 

00300 

00400 

oosoo 

0001 

0002 

0003 

0004 


C 

00500 

0005 



00500 

00500 

0006 



00500 



C 

00500 



C 

00500 



C 

00500 



C 

00500 



C 

00500 



c 

00500 



c 

00500 

00100 

0007 


c 

00200 

0008 



00300 

00400 

0009 



00500 

00600 



c 

00700 



c 

00800 



c 

00900 



c 

01000 



c 

01 100 



c 

01200 



c 

01300 



c 

01400 



c 

01500 



c 

01600 



c 

01700 



c 

01800 



c 

01900 



c 

02000 



c 

02100 



c 

02200 



c 

02300 



c 

02400 



c 

02500 



c 

02600 



c 

00600 

00700 

0010 

0011 



00700 

0012 



00700 



c 

00700 



c 

00700 



c 

00700 



c 

00700 



c 

00700 



c 

00700 



c 

00700 



c 

00700 

00800 

0013 

0014 



00800 

00800 

0015 




SUBROUTINE GYROUT 

DIMENSION TEMPO, 31 

REAL*B GO, DUMMY ,OMEG . TEMP, GAUSS 

INCLUDE ’ARRAYS.COM' 

COMMON /ARRAYS/ T 1 ( 3 ) , T2 ( 3 ) , T3( 3 ) , T4 ( 1 0 ) , T 1 1 ( 3 , 3 ) , T 33( 3 . 3 ) 

. , T 44< 4.4) , T66(6,6) ,T77(6,6) ,T5(4) ,T6(4) ,T7(4> 

REAL'S T 1 ,T2,T3. T4, T 1 1 , T33 ,T44 , T 66 , T77 , T5 , T6 , T7 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 

T 1 - T 4 SINGLE DIMENSION ARRAYS 

Til - T77 DUAL DIMENSIONED ARRAYS 
Til DUAL ARRAY; OFF DIAGONAL SET TO ZERO 

INCLUDE 'TIME.COM' 

COMMON /TIME/ T IME , TNEXT , T STOP . T I A , DEL . T IN , 0 TN , DF T EO , TZE RO 

, TMEAS. TRACK, T IS. T I SN , DT A , DATE R , TPR I NT , DT PR INT 
REAL*8 T IME, TNEXT , TSTOP,TIA,DEL,TIN,DTN,DATE0, TMEAS , TRACK , TIS , 

. TI SN,DTA,TZERO, DA TER, TPRINT.DT PRINT 

THESE ARE THE TIME REFERENCE FRAMES 

TIME 
TNEXT 
TSTOP 
TIA 
0 .L 
TIN 
DTN 
OATEO 
OATER 
TZERO 

tslew 
TIS 
TISN 
DTA 

TPRINT 
D1 °R IN T 

INCLUDE ’TMAT.COM' 

COMMON /TMAT/ A ( 3 , 3 ) , B ( 3 , 3 ) , C ( 3 , 3 ) , EM< 4 , 3) 

REAL'S A.B.C.EM 

TRANSFORMATION MATRICES 

A INERTIAL TO BODY AXES 

Q GYRO TO BODY AXES 

C GYRO NON-ORTHOGONAL TO GYRO AXES 

EM BOD v TO QUATERNIAN AXES 

INCLUDE ’NOISE.COM' 

COMMON /NOISE/ BWO ( 3 ) , SWD( 3 ) , BSF ( 3 ) , SS F ( 3) ■ B0( 3 ) , S D ( 3 ) 

. ,BDD( 3 ) ,SDU{ 3) ,SRM .BRE.SRE 

REAL'S BWO , SWD , BSF , SSF , BD , SO , BDD , SOD , SRM , BRE , SRE 


ATOMIC TIME SINCE INITIALIZATION (SEC) 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

RUN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

" •' STEP SIZE (SEC) 

POSITION INTEGRATION TIME (SEC) 

» * STEP SIZE (SEC) 

DATE OF FLIGHT EPOCH (UD) 

DATE OF 1950 EPOCH (JD) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

REAL WORLD REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY ♦ DEL BUT TSLEW - TIA WHEN DEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


1 
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00800 
00800 
00800 
00800 
00800 
00800 
00800 
00800 
00800 
00900 
00900 
00900 
00900 
00900 
00900 
00900 
00900 
OOSOO 
00900 
00900 
00900 
00900 
00900 
OiOOO 
01000 
01 c 0 
01000 
01000 
01000 
01000 
01000 
01000 
01000 
01000 
01 100 
01100 
01100 
01100 
01100 
01100 
01100 
01 100 
01100 
01 1 00 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 


REAL NORCO GYRO MEASUREMENT ERRORS 


c -n • ■ GYRO DRIFT (RAD / SEC) 

5"? He ■ * GYRO SCALE FACTOR 

. - GYRO NONORTHOGONALITY (RAD) 

jj° Q |° D . • GYRO RELATIVE ORIENTATION (RAO) 

INCLUDE 'ASTATE.COM' 

COMMON /ASTATE / DE ( 4 ) . E ( 4 ) . M0< 3 ) . SF ( 3) . D( 3 ) . DD( 3 ) 

REAL'S DE.E.WO.SF.D.OD 

ATTITUOE STATE ANO CONSIDERED ^ARAMETERS 

o D I FERENT 1 AL OF QUATERNIONS 

c' QUATERNIONS 

W Q GYRO DRIFT RATE (RAD/SEC) 

SF GYRO SCALE FACTOR 

n GYRO NON-ORTHOGANALt TY (RAD) 

00 GYRO RELATIVE ORIENTATION (RAO) 

INCLUOE 'ENVIR.CCM 

COMMON /ENVIR/ ST AT E ( 1 0 ) . PROF I LE ( 1 0 . * ) . INI T 
REAL'S STATE, PROFILE 

REAL WORLD STATE PARAMETERS 

STATE STATE VALUES: X,Y , Z. XD, YD, ZD, EO , El , E2 . E3 

PROFILE ATTITUDE PROFILE-TIME (SEC) VS 

INERTIAL ANGULAR RATES (RAD/SEC) 

INIT INTEGRATION INITIALIZATION KEY (-1) 

COMMON E /ROTAT / OTHR ( 3 ) , OTHEM< 3 ) , OTHE ( 3 ) 

REAL'S DTHR.DTH M.DTHE 

gyro ATTITUDE PARAMETERS 

nrns REAL WORLD GYRO DATA (RAO) 

niMFU FILTER WORLD GYRO DATA (RAD) 

OTHE fIlTER WORLD COMPENSATED GYRO DATA (RAO) 


dimension omES < 3 ) . dummy ( 3) 

interpolate* to* find*! ntert i al rates* between times instable 




00 ^IF 1 (PROFI L < I . 1 ) ■ LT . . 001 ) GO TO 200 
If ( TIME . GT . PROF I lE< I » 1 ) ) GO TO 200 
DO 100 J 1 2,4 

OMEG(J-I) = PRCEILE(I.J) ^ 

IF ( PBQF I lE ( i * 1 1 IIE( 1*1 » 1 ) 'GT. 

OMEGI-- ^ - ; (TIME-PROFILEC 1-1 .1 ) »/CP«OFILE( X . 1 )■ 
; PROFi“e( 1-1,1 ),).(PROFILE(I.U)-PROFILE( 1-1, U))' 

’ PROFILE! 1-1 .0) 

CONTINUE 


J 


GvQOvjr 
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VAX-11 FORTRAf v2.t ' 
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B« 0 * 


02500 

0033 

02600 

0034 

02700 

0035 

02800 

0038 

.2900 

00 3 7 

. 3000 

0038 

Ol’OO 


C 3200 


03300 


03400 

0039 

C 7500 


0 3600 


03700 


03800 

0040 

03900 


04 0 00 

004 1 

04100 


C42C0 

0043 

04300 


04400 


C4500 


04600 

0043 

04700 

0044 

04800 


049C0 


05000 


05100 

0045 

05200 


05300 


05400 


05500 

0046 

05800 

0047 

05700 


05800 

0048 

05900 


06000 

0049 

06100 


06200 


06300 


06400 


06500 


06600 


06700 

0050 

06800 

0051 

06900 

0052 

07000 


07100 


07200 


07300 


07400 


07500 

0053 

07600 

0054 

07700 

0055 

07800 


07900 

0056 

08000 

0057 


GO TO 2G5 
200 CONTI HUE 

205 IF I IENTEB.ED. 2) «=;-£<5.l25) 

125 FORMAT (• E NT Eft I . G 

tF < lENTEft.EO. 2 i • p : E 1 6 . 1 5 0 J time, OWES 
c> ’50 F Q ova T ■ TIME x'.rt,.,. OV E G « ' . 3 ( 1 X . £ 1 6. 9) ) 

C COMPUTE TRANSFORMATION MATSU FROM GYRO TO BOOT * COORD I NATES 


CALL BWA T( 300. Ml; 

c« ............ 

C COMPETE TRANSFORMATION MATSU 

call CMATIPSF, 80 . T 3 3 I 

c 


ACCOUNTING 


FOR Gtro NCNO«?hOGONALITV 


c 

c 

c 


c 

c 

c 

c 

c- 


c 


I F ( I ENT Eft . EO . 2 ) 

,, e 'e"! ITE ' 6 ' 1751 ‘ ,T1 ' ' 1 ' J> • J *’ - 3 > ■ * * 1 • 3 > • <<T33f I .J) . u«l .3) . 1 = 1 .3) 
li' 3 3M *' E,6 ' 9 >> ■ t> ' C IS'./. 3»3MX,E16.9(./)1 

find f In/EOSE OF C J • * INVERSE OF B)«INVERSE OF (B»C). STORE in'tEMp***** 


CALL MAT ABI T 1 1 . T33. TEVP, 3. 3,3) 

CALL MIN23(TFMP,TEMP / 

find 0 £AL WOBlG Change IN GYRO angles 

CALL MATA8I TFmP.CWES . T 1 , 3. 3, 1 ) 

CORRUPT REAL «C'= t 3 GcPO ANGlES WITm BIAS 

DO 300 1 « 1 , 3 

300 OThP(I) « ♦ 7 1 f I ) J • OTA 


IF (IENTES.E0.2I 

. MPI T Ef6.180/ f I T£MPf I , j ) . U*1 ,3) , I • 1 .3) .DTHR.DThEM 
100 FORMA T f INVESS O' 8 / 0 ' . / . 3f 3 ( IX, FI 6.9) . / ) . 

. ' REAL NOP1.D CHANGES N GTRO ANGLES' ,/, 3( IX .E18. 9 ) ./. 

• ' FILTER Chang S in GTRO angles * ,/.3(1X,E16.9>) 

C FIND FILTER «CRLO Change IN GtRO ANGLES 8/ ADD1 NG* RANDOM* ERROR 

C DuE tc drift 

C» 

00 = GAUSS'S. 0. S»0 ' I | ) 

4 00 QTH EM f I ) 5 0 t ^ r , ; , . GO*DTA 

C. 

C UPDATE REAL «0=LD CSATEPNION 

c NOTE: COMPENSATE »jth SAME 

C NOISE TERMS TO GET REAl WORLD 



IF < IENTER.E5. 2) wB I T E < 6 . 500 ) 

500 FORMAT!/ , ' CALL KA77 FOR RCAl WORLD ') 

CALL KATT(OThR , BWC . BOO.BSF , BO , DUMMY , ST ATE ( 7 ) 1 

C 

RETURN 

END 
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PROGRAM SECTIONS 



Name 

Bytes 

At t r i butes 







0 

SC ODE 

576 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

1 

$P DAT A 

271 

elC CON REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

2 

SLOCAl 

320 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 

3 

ARRAYS 

1096 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 

4 

T I ME 

136 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

5 

TMAT 

312 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

6 

NOISE 

216 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

7 

ASTATE 

160 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

8 

envir 

404 

PIC OVR REL 

GBL 

SHR 

NOEXE 

r,D 

•AT 

LONG 

9 

rotat 

72 

PIC OVR REL 

GBL 

SHR 

NOEXE 

!D 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 GYROUT 


VARIABLES 


Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

Address 

Typ« 

Nam« 

6-OOOOOOC8 

R*8 

8RE 

4-00000038 

R *8 

DATEO 

4-00000070 

R*8 

CATER 

4-00000020 

R *8 

DEL 

4-00 OOOC 58 

R*8 

OTA 

4-00000030 

R *8 

DTN 

4-00000080 

R*8 

DTPRINT 

2-00000078 

R*8 

GO 

2-00000080 

1*4 

I 

2-00000088 

1*4 

I ENTER 

8-00000190 

1*4 

INI T 

2-00000084 

I *4 

j 

6-00000000 

R*8 

SRE 

6-000000C0 

R *8 

SRM 

4-00000018 

R*B 

TIA 

4-00000000 

R*8 

time 

4-00000028 

R*8 

TIN 

4-000000S8 

R *0 

TIS 

4-00000060 

R*8 

TISN 

4-00000048 

R *8 

TMEAS 

4-00000008 

4-00000040 

9*8 

R*8 

TNEXT 

TZERO 

4-00000078 

R*8 

TPRINT 

4-00000050 

R*8 

TRACK 

4-00000010 

R*8 

TSTOP 


ARRAYS 


Address 

Type 

Name 

Bytes 

D ( mens Iona 

5-00 000000 

R*8 

A 

72 

(3. 3) 

5-00000040 

R*8 

B 

72 

(3, 3) 

6-00 000060 

R»8 

BO 

24 

(3) 

6-00000090 

R*8 

BOO 

24 

( 3 > 

6-00OOO030 

R*a 

BSF 

24 

(3) 

6-00000000 

R*a 

BWO 

24 

(3 ) 

5-00000090 

R»S 

C 

72 

(3, 3) 

7-00 000070 

R*e 

0 

24 

( 3 ) 

7-00000088 

R*0 

DO 

24 

(3) 

7-00000000 

R»8 

OE 

32 

(4) 

9-00000030 

R*8 

OTHE 

24 

(3) 

9-00000018 

R*8 

OTHEM 

24 

(3) 

9-00000000 

R*8 

DTHR 

24 

(3 ) 

2-00000048 

R*8 

DUMMY 

24 

(3) 

7-00000020 

H*8 

E 

32 

(4) 

5-000000D8 

R*8 

EM 

96 

(4, 3) 

2-00000060 

R*8 

OMEG 

24 

(3) 
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8-00000050 

R«8 

PROFILE 

320 

no, 4) 

6-00000078 

R*8 

SO 

24 

1 3 ) 

6-00 GC00A8 

R • 8 

SDD 

24 

( 3 ) 

7-00000058 

R*8 

SF 

24 

f 3 ) 

6-00000048 

P»8 

SSF 

24 

( 3 ) 

0-00 cooooo 

R*8 

STATE 

80 

(10) 

6-00000018 

R*8 

SsO 

24 

( 3 ) 

3-00000000 

R • 8 

T 1 

24 

( 3 ) 

3-00000098 

R»8 

Til 

72 

( 3 , 3) 

3-00000018 

R*8 

T2 

24 

( 3 ) 

3-00000030 

R-8 

T 3 

24 

( 3 ) 

3-OOOOOOEO 

R • 8 

T 33 

72 

( 3 . 3) 

s-ooooooae 

fl«8 

T 4 

80 

(10) 

3-00000128 

R>8 

T 44 

1 2b 

( 4 , 4) 

3-00 0003E8 

R • 8 

T5 

32 

( 4 ) 

3-00000408 

R • B 

T 6 

32 

(4 ) 

3-00 0001 A8 

R • 8 

T66 

288 

( 6 . 6) 

3-00000428 

R*8 

T7 

32 

( 4 ) 

3-00 0002C8 

R*8 

T77 

288 

( 6 , 3 ) 

2-00 000000 

R»8 

TEMP 

72 

(3. 3) 

7-00 000040 

R*8 

WD 

24 

(3) 


LABELS 






Address 

Lati# 1 

Address 

L3D# 1 

Address 

Label 

• * 

0-00 000088 

100 

205 

1-00000000 

« « 

125' 

300 

1-00000013 

• • 

ISO* 

400 


Address 

Lautl 

Address 

Label 

Address 

Label 

1-00000033 

1-000000E5 

175‘ 

500' 

1-00000062 

180* 

0-00000083 

200 


FUNCTIONS AND SUBROUTINES REFERENCED 
BMAT CHAT GAUSS 


MATAB MINV3 


Total Space Allocated • 3571 Bytaa 


command qualifiers 
fortran /list GCP 


INOATA.MATAB.OUTOATA.RJNG.DNAV.EPHEM.TRUEA 


, SPRESS , OCCULT , G^ERT , GCPSEQ .VISIBLE , GENENV . 


TREG.GYROUT, RAT E. BMAT. CMA 


/CHE CK = ( NO BOUNDS .OVERFLOW) 

/DEBUG* ( NO SYMBOL S, TRAC EBACK ) 

/F77 /NOG_FLOAT ING /I4 /OPTIMIZE /WARNINGS 


/NOO_LINE$ /NOMACHINE .CODE 


/CONT I NUAT IONS* 1 9 


COMPILATION STATISTICS 


Run Tim#: 
Elapsed Tim#: 
Pag# Faults: 
Oynamic Memory: 


2.92 second# 
40.70 seconds 
408 

160 pages 


2.3.3 Transformation from Euler Angles (BMAT) 


Subroutine BMAT uses DD(3) an array of Euler angles to generate the 

direction coeine .rr.y B<3,3). The B «trlx i. * n *"*L“'hi.^oordin.« ..t, 
transformation of data from the gyro coordinate set to the body coordinate set 


Processing Requirements 

The processing generates a standard Euler angle transformation with a 
rotational sequence starting from the gyro coordinates first about the z gyro 
Tel) Zn the q Taxis, followed by the x axis. All rotations are considered 

positive. 


Input Requirements 

DD - Euler angle arra> 

DD(1) 3 x-axis rotation (rad) 
DD(2) 3 y-axis rotation (rad) 
DD(3) 3 z-axis rotation (rad) 


Output Requirements 

B 3 Direction coeine transformation from gyro axes to body 
axes (unitless) 

Subroutines and Function Called - SIN, COS (Math Package) 
Calling Subroutines - GYROUT, KATT 


A- 100 








6-Apr— 1 981 14:50:07 
1 1 -Sep-1 980 11 : 01 :46 


VAX-11 FORTRAN V2.0-2 
_DBAO : [ D 1 1R.GC*' ]BMAT . FOR; 5 


Page 


0001 


0002 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


> 

I 


SUBROUTINE BMAT(DD,B) 

C 

C THIS ROUTINE COMPUTES the B<3.3) MATRIX 

C THE B MATRIX TRANSFORMS DATA FROM GVRO TO BODY COORDINATE 

C 

INCLUDE '0EBUG.COM' 

0003 • COMMON / DEBUG/ I EN TE R . 1 DEBUG 

• C 

• c USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

• c 

• c I NTER IF 1, PRINTS WHEN EN T ERS MOST SUBROUTINES 

• c IDEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 


• C 


0004 

dimension 

00(3 ) ,B( 3.3) 

0005 

REAL'S DO 

.b.cox.cdy.cdz.sox.soy.sdz 

0006 

COZ « C 0 S ( DD ( 3 ) 1 

0007 

SDZ « S 1 N( DO ( 3 ( ) 

0008 

CDY « COS{ D0( 2 ) ) 

0009 

SOY * S I N ( DO ( 2 | ) 

0010 

CDX » COS 

(00(1 ) ) 

001 1 

SOX « SIN(PO( 1 ) 1 

0012 

B( 1 ,1 ) « 

COZ'COY 

0013 

B( 1 ,2) • 

SOZ'COY 

0014 

B( 1,3) « 

-SDY 

0015 

B<2,1) « 

COZ'SOY'SOX-SOZ'COX 

0016 

B( 2 , 2) - 

SOZ*SOY*SDX+COZ«COX 

0017 

B( 2,3) • 

CDY'SOX 

0018 

B( 3. 1 ) ■ 

COZ«SOY«CDX+SOZ»SOX 

0019 

8(3.2) « 

SDZ»SOY«CDX-CDZ»SOX 

0020 

8(3.3) « 

CDY'CDX 

0021 

RETURN 


0022 

END 
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PROGRAM SECT IONS 


Name 


0 SCODE 

2 SLOCAL 

3 DEBUG 


Bytes Attributes 

223 PtC CON REL LCL SHR EXE 

88 PIC CON REL LCL NOSHR NOEXE 

8 PIC OVR REL GBL SHR NOEXE 


RD 

NOWRT 

LONG 

RD 

NRT 

QUAD 

RD 

WRT 

LONG 


ENTRY POINTS 


Add. ’ess Type Name 
0-00000000 BMAT 


VARIABLES 

Address Type Name 

2- 00000000 R»8 CDX 

3- 00000000 1*4 IENTER 


Address Type Name 

2-00000008 R *8 COY 
2-000000 1 8 R*8 SOX 


ARRAYS 


Address Type 

Name 

Bytes 

0 i mansions 

A P—00 000008# R*8 

B 

72 

24 

(3. 3) 
(3) 

AP-00 000004# R»8 

DO 


Address Type Name 


2-00000010 

2-00000020 


R*8 CDZ 
R-B SDY 


Address Type Name 

3-C0000004 1*4 1DEBUG 

2-00000028 R*8 SDZ 


FUNCTIONS AND SUBROUTINES REFERENCED 
MTHSOC OS MTHSOSIN 


Total Space Allocated « 319 Bytes 


COMMAND qualifiers 

FORTRAN /LIST GC P . INDA T A .MAT AB . OUT DAT A . RUNG . ON AV 


EPHEM.TRUEA.SPRESS.OCCULT.GPERT 


, GCPSEQ. VISIBLE .GENE NV ,T REG, GYRUUT . RAT E . 3MAT , CMA 


/CHE CK - ( NO BOUNDS .OVERFLOW) 

^r^Sui^^PTi-iie /warnings /nod.lines /nomachine.code /continuations.19 


COMPILATION STATISTICS 


Run ’ ine= 
Elapsed Time: 
Page Faults'- 
Dynamic Memory: 


I . 03 seconds 
14.26 seconds 
313 

160 pages 


2.3.4 Transformation from Quatemiana (AMAT) 

Subroutine AMAT completes the direction cosine matrix A(3,3) from the 
quaternian array E(4). The resulting A matrix may be used to transform data 
from the EC1 to body coordinates. 

Processing Requirements 

The standard transformation equations from quaternian elements to A matrix 
elements are used. Refer to Motensen, RE "Strapdown Guidance Error Analysis" 
IEEE Transactions on Aerospace and Electronic Systems May 1974, pp 451-457 

Input Requirements 

E * The quatet.iian array describing the body attitude in inertial space 
(unitless) 

Output Requirements 

A ■ Direction cosine matrix for transformation of data from ECI to body 
coordinator, (unitless) 

Subroutine and Functions Called - None 

Calling Subroutines - BVECT, LAMKT, HLMT, HSTAR, EST 

Mathematical Specification 

The transformation from a quaternian array to a direction cosine array is 
given by 


A * 


Ej 2 + E 2 2 - E 3 2 - Eq 2 
2 (E 2 E 3 - EjEq) 
2(E 2 E 4 + E!E 3 ) 


2(E 2 E 3 + E 1 E f+ ) 

E! 2 - E 2 2 + E 3 2 - E 4 2 
2(E 3 Ei ( - EjE,) 


2(E 2 E 4 - E jE 3 ) 

2 (EiE 2 + E 3 E 4 ) 

Ej 2 - E 2 2 - E 3 2 + E 4 2 


Where the quaternian array is given by 



A - 104 






401 - 


Pm •. 


ooo« 

0003 

0003 


0004 

00100 

00300 

00300 

00400 

00500 

00600 

00700 


6-Ai 1 -tut 1.1 '1:^.1 VAX-11 F I’k.-.ri 

1 1 - VO- 1 '*80 1100136 _0B401 [ D 1 1 M . CC 


SUtlROU" YE *w* r I E . A ) 

01 A E NS ! . £ I 4 1 . A ( 3 , 3 i 

REAL • B t . A , EOC . E 1 1 . E23 . 33. 


,f 02 .E03.E 12.E13.E23 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


0005 


TM I c Bntjt thf COMPU EE 5 T*'E A < 1.3* MATRIX 

THE A MATRIX TRANSFORMS DATA < POM EC I TO SEXTANT C00RN1NATES 


INRUT W *^; a ^“ TERN1AN T64V FORMATION FROM INERTIAL TO BOOT 


OUTPUT VARIABLES _ 

A * direction cosine transformation from inertial 
to BOOT 


CODE CHECKED BY JACK MYERS 7 JUNE '980 


INCLUDE ’0EBUG.COM' 

• COMMON /DEBUG/ 


IENTER . i DEBUG 



• 

C 



• 

c 

USER CONTROLLED 1 


• 

c 



• 

c 

I NTER I 


• 

c 

I DEBUG 0 


• 

c 


0006 



EOO « E ( 1 ) • E < 1 ) 

0007 



Ell • E< 2 ) *E ( 2 ) 

oooa 



C22 * E ( 3 I *E ( 3 I 

0009 



E33 * E ( 4 ) «E( 4 I 

0010 



EO 1 « E( 1 I * E ( 2 1 

001 1 



E02 « E< 1 )*E1 3 1 

0012 



EO 3 « E< 1 l*E(4 ) 

0013 



El 2 * E ( 2 1 »E ( 3 1 

0014 



El 3 * E( 2 ) »E ( 4 1 

0015 



E23 * E( 3I*E( 4 I 

0016 



A ( 1*1) » EOO + E 1 1-E22-E33 

001 T 



A( 1 .21 * 2 . • 1 E 1 2*£03 I 

00 IS 



A(1. 3) « 2 . • ( E 1 3-E02 1 

0019 



AI2.D « 2 . • ( E 1 2-E03 ) 

0020 



• ( 2.2) • EOO-E 1 1*E22-E33 

0021 



A ( 2,3) - 2 .•( E01 *E23 ) 

0022 



*(3.1) • 2 . • ( E 1 3*E02 I 

0033 



A( 3,2) • 2 . • ( E 23-E01 ) 

0024 



A ( 3.3) « EOO-E 11 -E23*E33 

0025 



RETURN 

002* 



END 


PARAMETERS TO VARY DEBUG PRINT LEVEL 


PRINTS WHEN ENTERS MOST SUBROUTINES 
HIGHER NUMBER MEANS MORE PRINT 




i i I— ■ 


ORIGINAL PAGE E 
OF POOR QUALITY 


PROGRAM SECTION: 


B-Apr-1981 14:54:54 
It -Sep- 1980 11:00:36 


WAX-11 FORTRAN V2.0-2 
_DBA0‘. [01 1R.GCp]AMAT. FOR: 3 


Pape 2 


Name 


Bytes Attributes 


0 SC ODE 

a slpcal 

3 OE BOO 


216 PIC CON PEL LCL SHR EXE RD NOMRT LONG 

120 PIC CON REL lcl noshr noexe ro *rt quad 

B PIC OVR REL OBL SNR NOEXE RO MRT LONG 


ENTRY POINTS 


Address 

0-00000000 

Type 

Name 
AM AT 



VARIABtES 

Address 

Type 

Name 

Address 

Type Name 

3-00000000 

R*B 

EOO 

2-00000020 

R*8 E0 1 

2 -ooooeooe 

r»b 

Ell 

2-00000038 

R*3 E 1 2 

2—000G004e 

R*S 

E23 

a-ooooooia 

R*B E33 

ARRAYS 

Address 

Type 

Name 

Bytes 

Dimensions 

AP -00 00000 a# 

r*b 

A 

72 

(3. 3) 

AP-00 000004* 

R*B 

E 

32 

(4) 


Total Space Allocated * 344 Bytes 
CONNAND QUALIFIERS 


Address 

Type 

Name 

Addrass 

Type 

Name 

2-00000023 

R *8 

E 02 

2-00000030 

R*S 

E03 

2-00000040 

R *8 

£13 

2-00000010 

R *8 

E22 

3-00000004 

1*4 

ioc bug 

3-60000000 

1*4 

IENTER 


fortran 


/LIST 


GCP. INOA TA. MAT A6.0U7DATA. RUNG. OH AV.CPH EM, TRUtA.SPRESS. OCCULT. GPERT.GCPSEQ. VISIBLE. .JENENV 


TREG.GYROUT.RATE.BMAT.CMA 


/CHECK*! NO BOUNDS .OVERFLOW) 

/DEBUG* ( N0SYN80 . S , TRAC EPACK | 

/ETT /NOG. FLOATING /I4 /CPTIMIIE /NARNINGS /NOD.LINES /NOMACHINE CODE /CONT INUATIONS-19 


COMPILATION STATISTICS 


Bun T int: 

Elapsed Tina: 
Psq# Faults: 
Dynamic Memory: 


I . IB seconds 

II. 63 seconds 

310 

160 pages 



2.4 PROCESS GYRO DATA (GYRO) 

, f tho Process Gyro Data Module is to process the 

atlg r t S « «-* i— i. 

determined b? one seen line o£ the ectence sen.or. 

^h 8 d ‘“ity C sc”e”f d ac!«, 8 anS to update 

^at the attitude of the s^cecraft can b™ » > 

accurately aa poa.ibl. at al ‘ “*1 ia need each time an attitude 

attitude state transition matrix, this ma • 

measurement is taken to propagate the covariance matrix. 

„ Process Gvro Data Module is the angular changes 

The major input to the Proces y length of this period 

aensed by the tyros during each .ample , perrod. Tb e la g £or one 8ca „ 

defaults to .1 second, which ia assumed to be the time 
line of the MIA . 

. • thrPe variables which correspond to the angular 

changes about the three orthogonal gyro axes during the 

most recent period. 

a thn Process Gvro Data Module are the initial 
Other input data required by which it is va iid (the last 

value of the attitude quaternion an attitude quaternion is initially 

attitude reference measurement J h axis . 

set with a default accuracy of .12b degrees au 

The attitude quaternion, " hl ^ ” Estimation Module whe^an attitude 
Module, is later updated by the St lgQ used by the State Estimation 

reference measurement is processed. reference measurement when 

Module for calculating the predicted attitude referen attitud * 

updating the attitude quaternion. The three componen 
quaternion are in the closed interval ^1, +1J • 

The attitude state transition ^“g^^^gt^tiorModule 1 ^ determine an 
Gyro Dat Module is later used 1 reference measurement is 

^r.ler“iThl.“oS.‘S r attitude state transition matrix is reset to 

the identity. 

The Process Gyro Data Module processes the constant 

- caicuuced dy 

the equation: 


’ A6i 


A6im + Wd x • 

At 

A6 2 

= B • C • 

A6im + w Dy * 

At 

A0 3 


A0 3m + Wp z • 

At 

L - 


— 



ii' 


A- 108 


where 


B ■ gyro miselignment trena format ion matrix 
C ■ gyro scale factor and non -orthogonality transition matrix 
- ®1» ^ e 2 » ^63 ■ compensated gyro data (radians) 

A 0 im, A02m* A 0 3 m _ j n p U t data from gyros (radians) 
w Dx» %y, w Dz « gyro constant drift rate (rad/sec) 


At “ gyro measurement interval (sec) 


The matrix C has the following components: 


C 


Sx 0 0 

-Sx*5j Sy 0 

-Sx ’62 - s y ,(S 3 Sz 


where 

■ gyro scale factors (radians /count) 

** gyro misalignment angles (radians) 

The matrix B has the following components: 

CA3’CA2 SA3*CA2 -SA 2 

SAi .SA2 *SA3 -CAi *SA3 SAj *SA2 "SA3+CA1 .CA3 CA2*SAi 
CA j *SA2 *CA3 +SAi *SA3 CAi *SA2 *SA3-SAi ‘CA^ CA2-CAJ 

where the abbreviations C and S are used for cosine and sine, respectively, and 
A3, A2 , A 1 *re Euler angles representing rotations about the z axis, y 
axis, and x axis, in that order. 

The compensated gyro data is then used to compute the dif ferenticl of the 
quaternion which is used to propagate the quaternion. The quaternion is used 
to update the attitude transition matrix. The net result of this module being 
an update in the SS attitude estimate and a new attitude transition matrix. 


S x» Sy, Sg 

5 l , 62 ♦ A3 


Compensate for Gyro drift (KATT) 


Compensate for Gyro nonorthogonality (KATT) 


Compensate for Gyro coordinate 
misalignment (KATT) 


Update quaternion with 
angular changes (KATT) 


Compute state partials, attitude 
parameter partials, and altitude state 
transition submatrices (PDATT) 


Load new attitude transition 
matrix (PATT) 











0001 

0002 

00100 0003 

00200 

00300 

00400 

00500 

00600 

00700 

0004 

0005 

0006 


0007 

0008 
0009 


0010 

00100 0011 
00200 

00300 0012 

00400 
00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 

0013 

0014 


0015 

0016 


6 “Apr— 1981 1451:41 VAX-11 FORTRAN V2.0-2 
28*Aug-t 980 15:54:20 _0BA0: [ D 1 1 1. . GC ¥ )GYRQ . FOR : 4 


SUBROUTINE GYRO 
INCLUDE 'OEBUG.COM' 

* COMMON /DEBUG/ I EN T E R , i DEBUG 

* C 

* C USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

* C I NT£R IP 1. PRINTS WHEN ENTERS MOST SUBROUTINES 

* c 1DEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 


C 

c 

c 

c 

c 

c 

c 


INCLUDE 'ROTAT.COM' 

COMMON /ROTAT / DTHR ( 3 ) , DTHEM(3) ,DTHE( 3) 
REAL'S OTHR.DTH M.OTHE 

GYRO ATTITUOE PARAMETERS 


DTHR REAL WORLD GYRO DATA (RAD) 

OThEM FILTER WORLD GYRO DATA (RAD) 

DTHE FILTER WORLD COMPENSATED GYRO DATA (RAD) 


INCLUDE 'ASTATE.COM' 
C 


C 

C 

C 

C 

C 

c 

c 

c 

c 

c 


COMMON /ASTATE/ DEI 4 ) , E ( 4 ) , WD( 3 ) , SF ( 3 ) ,0(3), D0( 3 ) 

REAL'S DE.E.WD.SF.D.DD 

ATTITUDE STATE AND CONSIOEREO PARAMETERS 

D OIFERENTIAL OF QUATERNIONS 

E QUATERNIONS 

WD GYRO DRIFT RATE (RAD/SEC) 

SF GYRO SCALE FACTOR 

D GYRO NON-ORTHOGANALITY (RAD) 

DO GYRO RELATIVE ORIENTATION (RAD) 


C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 


INCLUDE 'PHIA.COM' 

COMMON /PHIA/ PA(4,4 ) , TA(4 , 12) , PDA(4, 16) ,PHI A( 16, 16) , 

. COVA( 16 . 1 5) , POA( 1 6 , 16 ) ,QMAX 

REAL'S PA.TA.PDA.PhI A , COVA , POA ,QMAX 

THESE ARE THE ATTITUDE TRANSITION AND COVARIANCE MATRICES 


PA 

ATTITUDE 

STATE TRANSITION MATRIX 

TA 

N 

PARAMETER TRANSITION MATRIX 

POA 

■ 

DERIVATIVE OF TRANSITION MATRICES 

PHIA 

• 

AGGREGATE TRANSITION MATRIX 

COVA 

■ 

NEW COVARIANCE MATRIX 

POA 

» 

PREVIOUS COVARIANCE MATRIX 

qmax 

■ 

COVARIANCE NORM MAX 


IF ( IENTER.EQ. 1 ) WRITE'6,999) 

999 FORMAT ( ' ENTERING GYRO ') 

C UPDATE FILTER QU TERN I ON 

IF ( IENTER.EQ. 2) WRITE(6,100) 

100 FORMAT ( / ( ' CALLING KATT FOR FILTER WORLD') 

C"'« * 

C KATT 


Paoe 1 


VAX-11 FORTRAN V2.0-2 
_DBAO: [01 1 R . GCP JGYRO . FOR ; 4 

C COMPENSATE FOR GYRO DRIFT 

C COMPENSATE FOR NONORTHOGONALITY 

C COMPENSATE FOR GYRO M I 6S AL IGNMENT 

C UPDATE QUATERNION 

c- * *-*■--•••**'**• **** **•••**««»******* ♦•*****••*•**»***•*•*** 

0017 

C 

c 
c 

************ 

0018 CALL PDATT 

c*** **•»*.***•.. ************************ 

C LOAD NEW STAT. TRANSITION MATRIX 

C« •••••*•*•*•*****•••••••• •**•••**•***** 

0019 CALL PAT T ( PHI A , PA , T A ) 

0020 RETURN 

0021 END 


CALL KATT(OTHEM,WD,DD.Sf . 0 , DTHE , E ) 


PDATT 

COMPUTE STATE PAR T I A LS 


GYRO 


6" Apr- 1 98 1 14151141 
2B-AU8-1980 15:54:20 


program sections 



Name 

6y tes 

0 

SCODE 

94 

1 

SPQATA 

52 

2 

Slocal 

48 

3 

OE BUG 

8 

4 

ROTAT 

72 

5 

ASTATE 

160 

6 

PHI A 

7176 


ENTRY POINTS 

Address Type Name 
0-00000000 GYRO 


At tr i butes 
PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

0VR 

REL 

GGL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

□ VR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


VARIABLES 






Address 

Type 

Name 

A. dress 

Type 

Name 

3-00000004 

1*4 

IDEBUG 

3-COOOO 000 

1*4 

I ENTER 


Address Type Name 
6-00 00 1 COO R*8 QMAX 


ARRAYS 


Address 

Type 

Name 

6-OOOOOCOO 

R*B 

COVA 

5-00000070 

R*8 

0 

5-00 000088 

R»8 

DD 

5-00000000 

R*8 

DE 

4-00000030 

R*8 

DTHE 


Bytes 

Di mens * m* 

2048 

(16, 16) 

24 

(3) 

24 

(3) 

32 

(4) 

21 

(3) 





6-Apr-1 981 14:51:41 VAX-11 FORTRAN V2.0-2 Page 3 

ae-Aug-1980 15:54:2C _D9AC: [Si i R . GCP ] GYRO . FOR : 4 


4-00 0000 IB 

R»8 

D THEM 

24 

(3) 

4-00000000 

R»8 

DTHR 

24 

(3) 

5-00000020 

R*8 

E 

32 

(4 ) 

6-00000000 

R*8 

PA 

1 20 

(4. 4) 

6-00000200 

k»B 

PDA 

512 

(4. 16) 

i 6-00 000400 

R*8 

PHIA 

2048 

(16, 16) 

i 6-00001400 

R*8 

PDA 

2048 

(16, 16) 

j 5-00O0O0S8 

R*8 

SF 

24 

(3) 

| 6-00000000 

R*B 

TA 

384 

(4. 12) 

1 5-00000040 

R*B 

MO 

24 

(3) 

LABELS 

Address 

Labe l 

Address 

Label 


1-00000012 

100' 

1-00000000 

999' 



FI 'NOTIONS AND SUBROUTINES REFERENCED 
** PATT PDATT 


Tot-'- 1 :;d; ce Allocated ■ 7610 Bytes 


COMMAND QUALIFIERS 

FORTRAN /LIST CiC P, INCAT A , MAT AB.OUT DATA . RUNG , ON AV , EPH EM, TRUEA , SPR ESS, OCCULT ,GPERT , GCPSEQ. VISIBLE .GENENV . TREG , GVROUT , RAT E , BMAT , CMA 

> /CHECK* (NO BOUNDS .OVERFLOW) 

I /DEBUG* ( NOSYMBGl S , TRACEBACK ) 

“ / F77 /NOG.FLOAT ING / 14 /OPTIMIZE /WARNINGS /N00_LINE$ /NOMACHINE CODE /CONT INUATI 0NS« 1 9 


COMPILATION STATISTICS 

Ron Time: 1.04 seconds 

Elapsed Time: 12.51 seconds 

Page Faults: 326 



2.4.1 PROPAGATE ATTITUDE (KATT) 


This module finds the differential of the quaternion for the last gyro 
period and uses it to update the quaternion (i.e., propagate the attitude 
estimate) . 


The differential of the quaternion is calculated by multiplying the 
compensated gyro data in sextant coordinates by the sextant to quaternion 
transition matrix. This transition matrix is: 


-ei 

-e 2 

-e 3 

eo 

-e 3 

e 2 

e 3 

e 0 

_e l 

-3 2 

e l 

e 0 



where e ± is the i th element of the attitude quaternion. 

This differential is then added to the quaternion to determine the new 
attitude. 


A- 114 


1 r 


AniTUDE PROPAGATION (KATT) 


COMPUTE COMPENSATION OF GYRO OUTPUT FOR 
RELATIVE ORIENTATION (BMAT) 


COMPUTE COMPENSATION OF GYRO OUTPUT FOR 
NONORTHOGONALITY (CMAT) 


COMPUTE TRANSFORMATOR FROM 
INDIVIDUAL GYRO TO S/C 
COORDINATES 

TEMP * BMAT * CMAT 


COMPENSATE FOR GYRO DRIFT DTH - DRIFT 


TRANSFORM GYRO OUTPUT INTO BODY COORDINATES 
DTHUP = TEMP * TI 


COMPUTE CHANGE IN QUATERNION 


UPDATE QUATERNION (QMULT) 


UNITIZE QUATERNION (UNIT) 


Figure A-19 



6-Apr-1')B1 14:50:57 

6 -Nov- 1 980 10:29:06 


VAX-11 FORTRAN .'2.0-2 
_DBA0: [01 1 R . GC P ] K A T T . F OR ; 7 


Page 


00100 

0001 

00200 


00300 


00400 


ocsoo 


00600 

0002 

00100 

0003 

00200 


00300 


00400 


00500 


00600 


00700 


00700 

0004 

00800 

0005 

ooaoo 


00800 

0006 

00800 


00800 


OOROO 


00800 


00800 


00800 


00800 


00800 


00800 

0007 

00850 


00850 

0008 

00850 


00850 

0009 

00850 


00050 


00850 


00850 


00850 


00850 


00850 


G0P50 

0010 

00100 


00200 

0011 

00300 


C0400 

0012 

00500 


00600 


00700 


00800 


C0900 


01000 


01100 


012C0 


01300 


01400 


01500 


01600 


Cl 700 


01800 


01900 



c 

c 

c 

C 


c 

c 

c 


c 


c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUB ROUT INE KATT 1 DT-‘. ,:J iET.RELOR.se ALEE . NONOR ,DTHUP,QUAT) 

THIS SUBROUTINE L.: OATES THE REAL AND FILTER WORLD QUATERNIONS ABOUT 
THE BODY AXI S 


INCLUOE 'OEBUG.COM 

COMMON /DEBUG/ I ENT E R . I DE BUG 

USER CONTROLLED PARAMETERS TO VARY OFRUG PRINT LEVEL 

I N T t o IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
IDEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 


INCLUDE 'NOISE.COM 

COMMON /NOISE/ BWDi 3 ) .SWD( 3) ,BSF (3) ,SSF(3) ,BD(3) ,SD(3) 
, BDO( 3 ) . SDD( 3) . SRM , BRE , SRE 
RE AL*8 8WD.SW0 , BSF . SSF , 8D . SD.BDO , SOD . SRM , BRE , SRE 


REAL WORLD GYRO MEASUREMENT ERRORS 


BWO 

SWD 

85 F 

SSF 

BD 

SD 

800 

SDD 


GYRO DRIFT {RAD / SEC) 

GYRO SCALE FACTOR 

GYRO NONORTHOGONALITY (RAD) 

GYRO RELATIVE ORIENTATION (RAD) 


INCLUDE 'ARRAYS.COM' 


COMMON /ARRAYS/ T 1 ( 3 ) . T 2 ( 3 ) . T3 ( 3 ) . T 4 ( 1 0 ) . T 1 1 ( 3 , 3 ) , T33 ( 3 . 3 ) 

. ,744 i 4.4) . T66(6,6) ,T77(6,6) . T5(4) ,T6(4) ,T7(4) 

RE AL*8 T1 .T2.T3.T4, T 1 1 , T 3„ , T44 . T 66 . T77 , T5 . T6 . T7 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 

T 1 - T 4 SINGLE DIMENSION ARRAYS 

Til - T 77 DUAL DIMENSIONED ARRAYS 
Til DUAL ARRAY; OFF 01 AGIONA L SET TO ZERO 


INCLUDE 'TIME. COM ' 

COMMON /TIME/ TIME. TNEXT , T STOP . T I A , DEL, TIN, D TN , DAT EO , T2ER0 
. , TMEAS . TRACK ,TIS. T I SN , OT A , DAT E R . T PR l NT , DTPR I NT 

RE AL*B TIME.TNEXT.TSTOP.TI A.DEL.T I N,OTN, dateo.tmeas.tr AC K.TIS. 
. tisn,dta,tzero.dater.tpr::;:,dtprint 


THESE are THE time REFERENCE FRAMES 


TIME ATOMIC TIME SINCE INITIALIZATION (SEC) 

TNEXT TIME FOR NEXT POSITION INTEGRATION (SEC) 

TSTOP RUN TERMINATION TIME (SEC) 

TIA ATTITUDE INTEGRATION TIME (SEC) 

D L - * STEP SIZE (SEC) 

TIN POSITION INTEGRATION TIME (SEC) 

OTN " * STEP SIZE (SEC) 

OATEO DATE OF FLIGHT EPOCH (JD) 

OATER DATE OF 1950 EPOCH (UD) 

TZERO START TIME IN SECS. SINCE DATEO 

TSLEW TIME NEEDED TO SLEW AND ACQUIRE (SEC) 


> 

I 


KATT 


02000 
02 1 00 
02200 
02300 
02400 
02500 
02600 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 
02500 


0013 

0014 

0015 

0016 


0017 

0010 

0019 

0020 


02600 

0021 

02700 


02800 


02900 


03000 

0022 

03100 

0023 

03200 


03300 


03400 


03500 

0024 

03600 


03700 


03800 


03900 

0025 

040C3 

0026 

0' 00 

0027 

C 3 

0028 

04300 

0029 

04400 

0030 

04500 


04600 


04700 


04800 

0031 

04900 


05000 

0032 

0S100 

0033 


f 14:50:57 VAX-11 FORTRAN V2.0-2 

6 -Nov- 190 o '0 i 29! 06 _DBAO: [01 1 R* GCP ]KATT . FOR ; 7 

* S I IS PEAL wo «L0 REFERENCE TIME (SEC) 

• r If SN T1ME F0R NEXT R “ POSITION INTEGRATION (SEC) 

I l 0T * Vnn A , L ^ * ° EL BUT * TS ' EW - TU NHEN DU 

. ~ T 00 LARGE AT MEASUREMENT TIME 

. £ TPRINT time for print (SEC) 

, ” DTPRINT INCREMENT on TPRINT (SEC) 

t> l MENS ION OTH( 3),0RIFT(3) . RE LOR ( 3 ) , SCA LEF ( 3 ) , NONOR ( 3 ) , DTHUP( 3 ) 

♦ 0UAT(4). 0 TEMP(4) ,TEMP(3.3) 1 “ 1 3 1 * 

e 8E AL*8 OKIFT.OTH.OTHUP.OTEMP.OUAT.RELOR.SCALEF.TEMP.VDOT 

IF ( IENTER.GT. 1 ) WRITE(6.999) 

999 FORMAT ( ' ENTERING KATT •) 

MM............. 

§ .??t:!^:: e .:°:. reea : ive orientation and nonorthogonauty**** * 

CALI BMA T ( RE LOR , T I 1 ) .m,.....,,,.mm.»m.mm„mm, 

CALL CMAT(SCALEF. NONOR, T33) 

IF ( 1ENTER.EQ. 2) 

Ill i! : 1^.' f ; 

CALL MAT A8( Til , T33 . T EMP ,3,3,3) 

l COMPENSATE FOR DRIFT BY SUBTRACTING ESTImIteO CJIlUE 

00 too*! *«*1 

T1,I) “ OTH(I) - OR IFT(I)*0TA 

c transform gyro rates to body rates * ********************* 

CALL MATA8(TEMP,T1 .DTMUP, 3,3,1 ) * •••»**•••»**••*•***»,*.,,, 

c UPDATE OUATERNION mmm.m.m.m.m.mmmmm. 



OTEMP(I) ■ l.o - VDOT ( DTHUP , DTHUP . 3)/B . mmmmmm.mmmmm 

DO 200 I • 2.4 

2C0 QTEMP(I) ■ . 5*0 THUP ( I -1 ) 

CALL OMULT(OUAT.OTEMP.QUAT) 

iLii^! ER - E0 - 2) • T E( 6 , 250) DTHUP.PUAT 

C. * *'.3( IX.E16.9),/. ■ (JUAT « 1 ,4( 1X.E16.9)) 

c ” 

c* .................. ...... ........ 

CALL UNIT (QUAT , OUAT . 4 ) * •••*•*••*•••••••**••••••••• 

C 

RETURN 

ENO 


Rag* 


118 


4»WPPW*“" “»■ ■*■**«,. 


KATT 


program sections 


,*TTipf^^(ippp 


mm ii., ipi mm 
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Name 

0 SCOOE 

1 SPOATA 

* *LOCAL 

3 OC BUG 

4 "OISE 

5 arrays 

• time 


tRTRr POINTS 


> 

I 


Address 

0-00 000000 


variables 

Address 

4 - 00 oor oca 

6-00000068 

3- 00000004 

4- OOOOOOCO 
6-00000058 
6-00000078 


ARRAYS 


Ad dress 

4-00000060 
4-00000090 
4-00000030 
4-00000000 
AP-00 000008P 
AP— 00000004* 
A P-0 00000 IBP 
AP— 00 0000 1 4P 
2-00000000 
AP— 00 0000 I C P 
AP-00 OOOOOC P 
AP-00 00001 OP 
4-00000078 
4— 00 0000 A0 
4-00000048 

4- 00 0000 1 8 

5- 00000000 
5-00 000098 
5-00000018 
5-00000030 
S-OOOOOOEO 


Type Name 
KATT 


Type Name 

8*8 BRE 
8*8 OTA 
1*4 IDEBUG 
»*8 SRM 
8*8 TIS 
»•« TPRINT 


T ypa Name 

R*8 80 

8*8 800 
»*8 BSF 
8*8 BWO 
8*8 DRIFT 
8*8 OTM 
8*8 OTMUP 
1*4 NONOR 
8*8 OTEMP 
8*8 QUA T 
»*8 RELOR 
8*8 SCALEF 
8*8 SO 
8*8 SOO 
8*8 SSF 
8*8 SMO 
8*8 T 1 
8*8 Til 
8*8 T2 
8*8 T3 
»•• T33 


Bytes Attributes 


475 

ns 

384 

8 

216 

1096 

136 


PIC CON 
Pic CON 
Pic CON 
PIC OVR 
PIC OVR 
PIC OVR 
PIC OVR 


BEL LCL SHR EXE 
8EL LCL SHR NOEXE 
8EL LCL NOSHR NOEXE 
REL GBL SHR NOEXE 
REL GBL SHR NOEXE 
REL GBL SHR NOEXE 
*EL GBL SHR NOEXE 


80 NOWRT LONG 
80 NOWRT LONG 

80 wrt quad 

RD WRT LONG 
80 WRT LONG 
80 WRT LONG 
80 WRT LONG 


Address 

6-00000038 
6-00000030 
3-00000000 
6-00000 0 1 8 
6-00000060 
6-00000050 


Type Name 

8*8 OATEO 
8*8 OTN 
1*4 (ENTER 
R*8 T(A 
8*8 TISN 
8*8 TRACK 


Address Type Name 


6-00000070 

6-00000080 

2-0000006C 

6-00000000 

6-00000048 

6-00000010 


8*8 DATER 
8*8 DTPRINT 
1*4 0 

8*8 TIME 
»*B TMEAS 
8*8 TSTOP 


Address Type Name 


6-00000020 

2-00000068 

4-OOOOOODO 

6-00000028 

6-00000008 

6-00000040 


8*0 DE L 
1*4 I 

8*8 SRE 
R»B TIN 
8*8 TNEXT 
8*8 TZERO 


Bytes Di mens tons 


24 

(3) 

24 

< 3 > 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

12 

(3 1 

32 

(4) 

32 

(4) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

24 

(3) 

72 

(3, 3) 

24 

(3) 

24 

(3) 

72 

(3. 3) 
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R*8 

T 4 

80 

(10) 


5*00 000048 

1 28 

(4 . 

4) 

5-00 000 128 

R*8 

T 44 

32 

(4) 


5-00 0003E8 

R*8 

T5 

32 

(4) 


5-00000408 

B*8 

76 

288 

(6. 

6) 

5-00 000 1A8 

R*8 

T 66 

32 

(4) 


5-00000428 

R*8 

T7 

288 

(6. 

6) 

5-000002C8 
2-00 000020 

R*8 

R*8 

T77 

TEH* 

72 

(3. 

3) 


LABELS 

Address Labe I 
1-00000012 50 ' 


Address Lsoel 

• • too 


Address Label 

•• aoo 


Address Lobel Address Led.1 

1-OOOOOOn 250 * 1-00000000 999' 


functions 

BNAT 


AND SUBBOUTINES BEFERENCEO 
CM* T NATAB 


ONULT W*lt 


VDCT 


let* i Specs At toes ted - 2433 Bytes 


‘“ri- 


COMPILATION STATISTICS 


Bun Time: 
Elapsed T 1 met 
Pag* Faults; 
Dynamic Memory t 


1 .83 seconds 
19.48 seconds 
390 

180 pages 


2.4. 1.1 Matrix Multiply (MATaB) 


Subroutine MATAB is « utility routine that performs a matrix multiply of 
the fora 


A(L,M) X B(M,N) - c(L,M) 

Algorithm 

M 

C(I,J) - l A(I,K)*B(K,J) 
K-l 


Input Variablee 

A “ Firat matrix to be multiplied dimenaioned LXM 
B ■ Second matrix to be multiplier dimensioned MXM 
L " Row diaienaion of A and C 

M " Column dimension of A and row dimension of B 
N - Column dimension of B and C 


Output Variables 

C “ Resultant matrix dimensioned LXN 


Subroutines and functions called - None 
Calling Subroutines - Utility 


A-12U 


MATAB VCLR 



Figure A-20 
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program sections 

Name 

0 (CODE 

2 SLQCAL 

3 DEBUG 

ENTRY POINTS 

Address Type Name 
0-00000000 MATAB 


r 

Bytes Attributes 

216 PIC CON REL LCL SHR EXE RD NOWRT LONG 

184 PIC CON REL LCL NOSHR NOEXE RD MRT OUmD 

8 PIC OVR REL GBL SHR NOEXE RD WRT LONG 


VARIABLES 

Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

2-00000008 

1*4 

I 

3-00000004 

1*4 

I DEBUG 

3-00000000 

1*4 

IENTER 

2-OOCOOOOC 

1*4 

J 

2-00000010 

1*4 

K 

AP-000000109 

1*4 

L 

AP— 000000149 

1*4 

M 

AP-000000 1 89 

1*4 

N 

2-00 000000 

R*8 

SUM 
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matab 
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ARRAYS 


Address Type Name 


Bytes Dimensions 


A P—00 000004# R«9 A 
A P-0 000 000 8 P R*8 B 
AP-OOOOOOOC# R»0 c 


** (* . *) 

*. ( . , *} 

•* (• I •) 


LABELS 

Address Label 
** 10 


Address Label 

*• 20 


Total Space Allocated • 40B Bytes 


COMMAND QUALIFIERS 

FORTRAN /LIST GCP. INDATA, MATAB. OUTOATA, RUNG, DNAV.EPHEM, TRUEA.SPRESS, OCCULT, gpert.gcpseq. VISIBLE, GENENV.TREG.GYROUT, RATE, BMAT.CMA 

/CHE CH=< NO POUNDS .OVERFLOW) 

/0E8UG= < NOSYMBOL S . TRACEBACK ) 

/F77 /NOG.FLOAT ING / 14 /OPTIMIZE /WARNINGS /NOD_LINES /NOMACHINE CODE /CONT INUAT I ONS» 1 9 


COMPILATION STATISTICS 

Run lime: 0.91 seconds 

Elapsed Time: 11.50 seconds 

Page Faults: 283 

Oynamic Memory: 160 pages 


2.4.2 COMPUTE STATE PART1AL8 ( PD ATT) 


This module computes the state psrtials end the $ end 0 submatrixes of the 
attitude tranaition matrix. Tbeae modules are loaded in the Load Transition 
Matrix module to form a new attitude tranaition matrix. 

Two parts of the augmented state transition matrix 4 A ere updated each 
time the gyro data becomes available. The matrix *A contains l)a submatrix 
which represents the partial derivative of the quaternion with respect to the 
value of the quaternion at the time the last measurement is processed, and 2) 
a submatrix which represents the partial derivative of the quaternion with 
respect to gyro model parameters (drift, non -orthogonality , scale factor and 
misalignment). The mathematical equations are more easily read if the 
matrix is partitioned 

d> e~ 

0 I 



where 

<j> contains partial derivative of attitude quaternion with respect to the 
value of the quaternion at the last measurement time, 

6 contains partial derivative of attitude quaternion with respect to gyro 
model parameters, and 

1 is an identity submatrix 


A- 124 


Tb« submatrix $ is updated each tine the gyro date becomes available with 
the following equation 

$(t A + 1, t 0 ) - F' d>( ti , to) 
where F is the state gradient matrix for attitude and 


_1 

2 


0 

-A0j 

— A8 2 

-A0 3 

A0j 

0 

A0 3 

-A0 2 

A0 2 

-A03 

0 

A0! 

A0 3 

+A0 2 

1 

o 

a> 

0 


$(*1 + l»to)» state transition submatrix between times t Q and tj + 1 

- compensated angular changes sensed by the strapdown gyros • 

The submatrix 6 is updated each time the gyro data becomes available using 
the equation 

6(ti + 1, t 0 ) = F' 0(t lf t o ) + E 

where E is the parameter gradient matrix for attitude 




-e l 

“ e 2 

_e 3 



e 0 

-^3 

e 2 

E = 1 





2 


e 3 

60 

_e l 



-e 2 

e l 

e o 

the parts 

of 

the 

partition* 



At 

0 

0 



0 

At 

0 



0 

0 

At 


Mi 

m 2 

M 3 

Mu 

- 



— 


(drift) 


«fiwf 


0 


0 


0 


— A0im — ^®2m 


(non-orthogonality) 


A9 2m 0 


(scale factor) 


-A9m3 A9m2 


-A0m2 


-A6 m i 


(misalignment) 


where A0 m i, A9 m2 , A0m 3 , - most recent gyro data. 

The net results of this module are updated $ and 0 submatrices. 

2.4.3 LOAD ATTITUDE TRANSITION MATRIX (PATT) 

This module uses the attitude state transition submatrix ( J) and the 

transition matrix each time gyro data is received. 


A-126 


COMPUTE ATTITUDE STATE PARTIALS (PDATT) 


COMPUTE F " MATRIX (STATE GRADIENT MATRIX) 
COMPUTE E (PARAMETER GRADIENT MATRIX) 


COMPUTE SCALE FACTOR PORTION OF M 
E ' = E ' * (I/I/M3/I) 


COMPUTE NONORTHOGONALITY PORTION OF M 


= E ‘ * (I/M2/I/I) 


COMPUTE DRIFT PORTION OF M 


= E' * (Mi/I/I/I) 


COMPUTE MISALIGNMENT PORTION OF M 


= E' * (I/I/I/M4) 


ATTITUDE PARAMETER TRANSITION MATRIX T 


Figure A- 21 


ft! 
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oo i oo 
00200 
00300 
00400 
00500 
03600 
00700 
00800 
00900 
01000 
00 1 00 
00200 
00300 
00400 
00500 
00600 
00700 
O' 100 
01200 
01200 
01200 
01200 
01 200 
01200 
01 200 
> 01200 
L 01200 

u. 01200 
Vj 01200 
0’ 200 
r 1200 

31200 
01300 
01 3C0 
01300 


0001 


SUBROUTINE PDATT 


r r , tn fQRviS PHI AND THETA SUBMATRIXES 

c COMPUTES STATE p P TRANVTlU’i MATRIX WHERE 

C OF THE ATTITUDE TRAN,.! I nERlvATIV E 


C 

c 

c 

c 

c 


0002 

0003 


• C 

• C 

« c 

• c 

• c 

• c 


0004 


. c 


0005 

0006 


* C 
. C 

♦ C 

• C 

• c 

• c 

* c 
« c 

* c 

• c 


0007 

0008 
0009 


01300 


01 300 


01300 


01300 


01300 


01300 


01300 

0010 

00100 

001 1 

00200 


00300 

0012 

00400 


00500 


00600 


00700 


00800 



* 

* c 

♦ c 

* c 

• c 

» c 

- c 

- c 


00900 
01000 
01 100 
01200 
01300 
01400 
01400 


iSkismo, "KJ, OF THE attitude QUATERNION 
” ^hTspect t£\ cuaternion 

l ^%SK£r? 0 P 0^o5r W piUTEPS. 


INCLUDE ' ‘ ‘TfnTF R 1DEBUG 

COMMON /DEBUG/ ’ DEBUG PRINT LEVEL 

USER controlled parameters to vary 

USER uu ..oct RilRROUT 


0013 


I nter 

IOEBUG 


„ , U T? WHEN ENTERS MOST SUBROUTINES 
HIGHER NUMBER MEANS MORE PRINT 


INCLUDE 1 AST AT E .COM ' 


E ATTITUDE STATE and CONSIDERED PARAMETERS 
INFERENTIAL of quaternions 

OUATERNI0NS 

GYRO DRIFT RATE (RAD/SEC) 

GYRO SCALE FACTOR / p ah ) 

ss <«■» 


D 

E 

WO 

SF 

0 

DO 


INCLUDE 'GFPART.COM' eM4(12 ),fn<6.6) 
COMMON /G F PART / FA(4.4),t 

REAL’S FA.EA.FN 

MEASURMENT and state partials 


FA 

EA 

fn 


ATTITUDE CON^DERED 1 PARAMETERS PARTIALS 

STATE PARTIALS 


• 

• C 

• C 

• c 

• C 

• c 

s. C 

• c 

• c 

• c 

• c 

• c 


INCLUDE 'eHlA.CONU tM 4,12),P0A(4.16).PH1A<16.16>. 

COMMON /PHI A/ PA ( 4 6 4 ) . TA( ^ ^ 

‘ REAL,B ^^^nESE^ ARE^ TH^ AT T ITUDE^ TRANS I T ION AND COVARIANCE MATRICES 

attitude state transition MATRIK tru 

nr^vATIVE OF TRANSITION MATRICES 

AMREGATE TRANSITION MATRIX 

rOVARIANCE MATRIX 
' PREVIOUS COVARIANCE MATRIX 

COVARIANCE NORM MAX 


PA 

TA 

POA 

PH I A 

COVA 

POA 

QMAK 


include • ARRAYS.COM' 










» # > jn *• * ‘W*?*«* 


pdatt 





6"Apr— 1 981 14:51:56 VAX-11 FORTRAN V2.0-2 






6-Nov-1980 10:33:00 _DBA0: [01 1R.GCP JPDATT 

01500 


• 

C 



01500 

0014 

• 

COMMON /ARRAYS/ T 1 ( 3 ) . T2 ( 3 ) . T3 ( 3 ) , T4< 1 0 ) , T 1 1 ( 3 . 3 ) . T33< 3 . 3 ) 

01500 


• 

• 

,T44( 4,4) . T66< 6.6) ,777(6,6) ,T5(4) , 76(4) ,T7(4) 

01500 

0015 

• 

RE AL»8 T1 .T2.T3.T4, T1 1 ,133,144,166,777,15,76,17 

01500 


• 

C 



01500 


• 

C 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 

01500 


• 

c 



01500 


• 

c 

T 1 - T 4 

SINGLE DIMENSION ARRAYS 

01500 


* 

c 

Til - T77 

DUAL DIMENSIONED ARkAYS 

01500 


• 

c 

Til 

DUAL ARRAY; OFF DIAGIONAL SET TO ZERO 

01500 


♦ 

c 



01500 

0018 


INCLUDE '7MA7.COM' 


01600 

0017 

• 

COMMON /7MA7/ A ( 3 , 3 ) . B ( 3 , 3 ) , C ( 3 , 3 ) , EM ( 4 , 3 ) 

01600 

0018 

* 

RE AL*8 A.B.C.EM 


Cl 600 


0 

C 



01600 


• 

C 

TRANS FORMAT ION 

MATRICES 

01600 


* 

C 



01600 


* 

C 

A 

INERTIAL TO BODY AXES 

01600 


• 

C 

B 

GYRO TO BODY AXES 

01600 


♦ 

C 

C 

GYRO NON-ORTHOGONAL TO GYRO AXES 

01600 


• 

C 

EM 

BODY TO QUATERN I AN AXES 

01600 


• 

C 



01600 

0019 


INCLUDE 'ROTA7.COM' 


01700 

0020 

+ 

COMMON /R07AT / DIMR i 3) , DTHEM( 3 ) , D7HE{ 3) 

01700 

0021 

• 

RE AL*8 DTHR.01H M.DTHE 


01700 


• 

C 



01700 


• 

C 

GYRO ATTITUDE 

PARAMETERS 

01700 


0 

C 



01700 


0 

C 

DTHR 

REAL WORLO GYRO DATA (RAC/ 

01700 


• 

C 

DTHEM 

FILTER WORLD GYRO DATA (RAD) 

01700 


• 

C 

DTHE 

FILTER WORLO COMPENSATED GYTO DATA (RAD) 

01700 


* 

c 



01700 

0022 


INCLUOE '7IME.COM' 


00100 


* 

C 



0C200 

0023 

• 

COMMON / 7 IME/ TIME. TNEXT.TSTOP.TIA, DEL, TIN, 07N,DA*E0.72ERO 

00300 


* 

• 

, TMEAS, TRACK , T IS . 7 ISN , DTA , OATER . TPR I NT ,DT PRINT 

00400 

0024 

• 

RE AL*B TIME.TNEXT.TSTOP, T I A.OEL, T IN , DTN . DATE 0 , TMEA S , TR ACK , T I S . 

00500 


• 

• 

TISN.DTA.TZERO.DATER.TPRINT.DTPRINT 

00600 


• 

C 



00700 


• 

C 

THESE ARE THE 

TIME REFERENCE FRAMES 

OOSOO 


• 

c 



009C0 


• 

c 

TIME 

ATOMIC TIME SINCE IN I I AL I ZAT I ON (SEC) 

01000 


• 

c 

TNEXT 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

01100 


• 

c 

TSTOP 

RUN TERMINATION TIME (SEC) 

01200 


• 

c 

TIA 

ATTITUOE INTEGRATION TIHE (SEC) 

01300 


* 

c 

D L 

” " STEP SIZE (SEC) 

01400 


• 

c 

TIN 

POSITION INTEGRATION TIHE (SEC) 

01500 


• 

c 

OTN 

STEP SIZE (SEC) 

01600 


• 

c 

DATEO 

DATE OF FLIGHT EPOCH (jO) 

01700 


0 

c 

OATER 

DATE OF 1950 EPOCH { JD3 

01 BOO 


• 

c 

T ZERO 

START TIME IN SECS. SINCE DATEO 

01900 


0 

c 

TSLEW 

TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

02000 


0 

c 

TIS 

REAL WORLD REFERENCE TIME (SEC) 

02100 


0 

c 

TISN 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 

02200 


0 

c 

OTA 

USUALIY + DEL BUT ♦ TSLEW - TIA WHEN DEL 

02300 


0 

c 


TOO LARGE AT MEASUREMENT TIME 

02400 


0 

c 

TPRINT 

TIME FOR PRINT (SEC) 


Pm g« 2 


- V 



POATT 


02500 

02600 

01800 

01900 

02000 

02100 

02200 


06900 

07000 

07100 

07200 
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0025 

0026 

0027 

0028 
0029 


0066 

0067 


999 


998 


OTPRINT INCREMENT ON TPR1NT (SEC) 

REAL«8 DTI , DT 2 .0T3.E0.E1 ,E2, E3 , T SLEW 
IF ( IENTER.GT. 1 ) WRITE<6,999) 

FORMAT ( ' entering POATT ') 

IF ( IDEBUG.GT. 3) HR I T E ( 6 ,998 ) TSLEH 
FORMA T(4X, 1 IN PDATT, TSLEH • ‘.F20.6) 


02300 

02400 


c- 

C 

COMPUTE F' STATE GRAOIENT MATRIX 


02600 

0030 


DT 1 * . 5 *DTHE ( 1 ) 


02700 

0031 


0T2 * . 5 *C'THE (2) 


02800 

0032 


0T3 * . 5 »OTHE ( 3) 


02900 

0033 


FA( 1 .2) » — OT 1 


03000 

0034 


FA< 1 ,3) • -DT 2 


03100 

0035 


FA< 1 ,4) « -DT 3 


03200 

0036 


FA(2,1) - DTI 


03300 

0037 


F A ( 2 , 3 ) » DT 3 


03400 

0038 


FA(2,4) • -DT 2 


03500 

0039 


FA(3,1) « DT 2 


03600 

0040 


FA ( 3 , 2 ) * -DT 3 


03700 

0041 


c A ( 3,4) « DTI 


03800 

0042 


FA(4,1) * DT 3 


03900 

0043 


FA(4,2) * DT 2 


04000 

0044 


FA<4,3) « -DTI 


04200 


c 

COMPUTE BODY TO QUATERNION AXES TRANSFORMATION 


04400 

0045 


EO * . 5* E ( 1 ) 


04500 

0046 


El * . 5* E( 2 ) 


04600 

0047 


E2 * . 5* E ( 3 1 


04700 

0048 


E3 * .5*E(4) 


04800 

0049 


EM (1,1) « -El 


04900 

0050 


EM ( 1.2) * -E2 


05000 

0051 


EMI 1 ,3) * -E3 


05100 

0052 


EM (2,1) * EO 


05200 

0053 


EM (2,21 « -E3 


05300 

0054 


EM (2,3) * £2 


05400 

0055 


EM (3,1) « E3 


05500 

0056 


EM (3, 2) « EO 


05600 

0057 


EM (3,3) ■ -El 


05700 

0058 


EM (4,1) . -E2 


05800 

0059 


EM (4,2) • El 


05900 

0060 


EM (4,3) * EO 







06100 


c 

COMPUTE SCALE FACTOR PORTION OF M, MS 







06300 

0061 


DO 20 1*1,3 


06400 

0062 


DO 10 J* 1 ,3 


06500 

0063 

10 

T33( I.JI ■ 0. I 

INITIALIZE T3. 

06600 

0064 

20 

T 1 1 ( I , I ) * DTH EM( I ) 


06700 

06800 

0065 

C- 

CALL MATAB(EM, T1 1 ,EA( 1 .4) ,4,3,3) I 

E»[0/0/M3] 


COMPUTE NONORTHOGONALITY PORTION OF M, M2 

T33(2, 1 ) - -OTH M( 1 ) 

T33(3,2) • — OTH_M( 1 ) 


131 



PDATT 

07300 0068 T3 3 ( 3 , 3 ) « -0TH M(2) 

07400 0069 CALL MATAB<EM. T33.EA( 1 ,7) ,4.3,3) ! 

07500 C 

07600 C COMPUTE DRIFT PORTION OF M 

07700 C 


07800 

0070 


DO 30 1*1,3 


07900 

0071 

30 

T1 1 ( I , I) * ~ D T A 


08000 

0072 


CALL MAT AB( EM , Til, EA, 4, 3, 3) 

1 






08200 


C 

COMPUTE MISALIGNMENT PORTION OF M 







08400 

0073 


T331 1,2) « -DTH M( 3 ) 


08500 

0074 


T33( 1.3) « DTH M( 2 > 


00600 

0075 


T3312.1 ) * DTH M(3) 


08700 

0076 


T33( 2.3 ) « -DTH M( 1 ) 


08800 

0077 


T3 3( 3 , 1 ) « -DTH M<2) 


08900 

0078 


T 3 3 ( 3 , 2 ) « OTH.M(I) 


09000 

0079 


T3313.3) * 0. 


09100 

0080 


CALL MATABIEM. T33.EA( 1 . 10) ,4,3,3) 

! 

09200 

0081 


CALL MAT AB( FA, PA, PDA ,4,4 ,4 ) 

1 

09300 

0082 


CALL MATAB( FA, TA . PDA ( 1 .5) , 4,4, 12) 

1 

09400 

0083 


00 40 1*1.4 


09500 

0084 


DC 40 <J*5, 16 


09600 

0085 


PDA(I.d) * EA ( I , J-4 ) +PDA( I , d ) 

1 

09700 

0086 

40 

CONTINUE 


09800 

0087 


DO 50 1*1,4 


09900 

0088 


DO SO d*1 ,4 


10000 

0089 

SO 

PA ( I , J ) * PA( I . J)*PDA< 1 ,d) 

1 

lOIOd 

0090 


DO 60 1*1,4 


10200 

0091 


DO 60 J-1,12 


10300 

0092 

60 

T A ( I , J ) - TA( X , U )*PDA ( 1 , J+4 ) 


10400 

0093 


RETURN 


IOSCO 

0094 


END 




-Apr-1981 14:51:56 VAX-11 FORTRAN V2.0-2 P»g« 4 

-Nov-1980 10:33:00 _DBA0 : { D 1 1 R . GCP ] PDATT . FOR ; 5 

E* [ 0/M2/M3 ] 


E* [Ml /M2/M3 ) 


E [Ml /M2/M3/M4 ] 
DQ+DQ 
F • THETA 


F * THETA ♦ E 




[PHI, 


$) 


THETA] 




PDATT 


PROGRAM SECTIONS 



Na -t x*» 

Bv T e? 

A t t r i bu‘ 

ies 

0 

SC ODE 

BOO 

PIC 

CON 

REl 

1 

SPOATA 

E-8 

PIC 

CON 

rel 

2 

SLOCAL 

248 

PIC 

CON 

REl 

3 

DEBUG 

8 

PIC 

OVR 

rel 

4 

AS TATE 

160 

PIC 

0 VR 

rel 

5 

GF PART 

800 

PIC 

CVR 

rel 

■3 

PH I A 

7 1 76 

PIC 

OVR 

rel 

7 

ARRAYS 

1C 96 

PIC 

OVR 

rel 

8 

that 

312 

PIC 

OVR 

rel 

9 

ROTAT 

72 

PIC 

□ VR 

rel 

0 

time 

136 

Pic 

OVR 

rel 


ENTRY POINTS 


6-*p''-1981 14:51:56 VAX-11 FORTRAN V2.0-2 Fag* S 

6-Nov-1980 10:33:00 _DBAO: [01 1 R. GCP ) PDATT . FOR ; 5 


LCL SHR EXE RD NCWRT LONG 
LCL SHR NOEXE RD N0V»RT LONG 
LCL NOSHR NOEXE RD WRT QUAD 
G6L SHR NOEXE RD WRT LONG 
G8L SHR NOEXE RD WRT LONG 
G8L SHR NOEXE RD WRT LONG 
GBL SHR NOEXE RD WRT LONG 
GBL SHR NOEXE RD WRT LONG 
GBL SHR NOEXE RD WRT LONG 
GBL SHR NOEXE RD WRT LONG 
GBL SHR NOEXE RD WRT LONG 


Address Typ* Nam* 
0-00000000 POATT 


VARIAB! ES 


Address 

Type 

Name 

Addre ,s 

T ype 

Nam* 

10-00000038 

R*a 

DATEO 

10-00030070 

R*8 

DATER 

2-00000008 

R*a 

DT2 

2-OCCOOOIO 

R * 8 

DT3 

10-00000080 

R*8 

OTPRINT 

2 -COOOO 0 1 8 

R»8 

EO 

2-00000030 

R*8 

E3 

2-00000040 

I *4 

I 

2-00000044 

1*4 

J 

6-00001 COO 

R»8 

□MAX 

10-00000028 

R»8 

TIN 

10-00000058 

fi *8 

TIS 

10-00000008 

R*8 

TNEXT 

10-00000078 

R *8 

TPRINT 

10-00000010 

R*8 

TSTOP 

10-00000040 

R • 8 

T ZERO 


Address 

T ype 

Na-^e 

Address 

Type 

Name 

10-00000020 

R*8 

DEL 

2 -ooooooeo 

R*8 

DTI 

10-00000068 

r*b 

DTA 

10-00000030 

R*8 

DTN 

2-00000020 

R*8 

El 

2-00000028 

R*8 

E2 

3-00000004 

1*4 

IDE BUG 

3-00000000 

I *4 

I ENTER 

1 0-000000 1 B 

R*8 

TIA 

10-00000000 

R*8 

T I WE 

lO 00000060 

R*8 

TISN 

10-00000048 

R»8 

TMEAS 

10-00000050 

R*8 

TRACK 

2-00000038 

8*8 

TSLEW 


ARRAYS 


Address 

Type 

Nam* 

Bytes 

D i mens 1 on* 

8-00 OOOOOO 

R*8 

A 

72 

(3. 

3) 

8-00000048 

R • 8 

8 

72 

(3. 

3) 

8-00 000090 

R»8 

C 

72 

(3. 

3) 

6-00 OOOCOO 

R«8 

COVA 

2048 

<16 

, 16) 

4-00000070 

R*8 

D 

24 

( 3 ) 


4-00000088 

R*8 

DO 

24 

(3) 


4-00000000 

R*B 

OE 

32 

<4) 


9—00 000030 

R*B 

DTHE 

24 

<3) 


9-00000018 

R*8 

□ THEM 

24 

(3) 


9-00000000 

R*8 

othr 

24 

(3) 


4-00000020 

R*8 

E 

32 

(4) 


5-00000080 

R*8 

EA 

384 

<4, 

12) 

8-00000008 

R*8 

EM 

96 

<4. 

3) 

5-00000000 

R*8 

FA 

1 28 

<4. 

4) 

5-00000200 

R*8 

FN 

268 

(6. 

6) 



POATT 


6-Apr-1981 14:51 : 56 
6-NOV-1980 10:33:00 


VAX-11 FORTRAN V2.0-2 
_DBAO: [01 1 R . GCP ) PDATT . FOR; 5 


Pag* 


6-00 000000 
6-00000200 
6-00000400 

6- 00001400 
4-00000058 

7 - 00000000 
7-00 000098 
7-00000010 
7-00000030 
7-ooooooeo 
7-00000048 
7-00000128 
7-000003E8 
7-00000400 
7-000001 A8 
7-00000420 
7-000002C8 
6-00OOO080 
4-00 000040 


R.0 

PA 

R*8 

PDA 

R.0 

PHIA 

R«B 

POA 

R«0 

SF 

R«S 

T 1 

R*0 

Til 

R.0 

T2 

R.0 

T3 

R.0 

T 33 

R.0 

T4 

R.0 

T44 

R.0 

T5 

R.0 

T6 

R*8 

T66 

R*0 

T7 

R.0 

T77 

R.0 

TA 

R.0 

WO 


1 28 

(4. 

4) 

512 

14, 

16) 

2040 

( 16 

. 16 

2040 

( 16 

, 16 

24 

(3) 

24 

(3) 


72 

(3. 

3) 

24 

(3) 


24 

(3) 


72 

(3. 

3) 

00 

(10) 

1 28 

(4, 

4) 

32 

(4) 


32 

(4) 


200 

(6, 

6) 

32 

(4) 


20B 

<6. 

6) 

304 

(4. 

12) 

24 

( 3 ) 



LABELS 

Address 
• • 

1-00000013 


Lab* I 
10 

990 ' 


Address 


Label 


•• 20 
1-00000000 999' 


Address 
• • 


Label 

30 


Address 
• • 


Label 

40 


Address 

ee 


Label 

50 


Address 


Label 

00 


FUNCTIONS AND SUBROUTINES REFERENCED 
MATAS 


Total Space Allocated ■ 10666 Bytes 


command oualifiers 

fortran /list GCP. INOAT A. MAT A0. OUT 0ATA. RUNG, ONAV.EPMEM, TBUEA.SPR ESS, OCCULT. GPcRT .GCPSEO. VISIBLE. GENENV.TREG.GVROUT. RAT E.BMAT.CMA 
/CHECK. (NO bounds .overflow) 

/DEBUG* I NOSvMBOL S . TRAC EBACK ) 

/F77 /NOG_FLOATING /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACMINE.COOE /CONT INUATI0NS-19 


COMPILATION STATISTICS 


Run Tim*: 
Elapsed Time: 
Pag* Faults: 
Dynamic Memory: 


3.46 second* 
62.49 seconds 
370 

100 pages 


j.4.3 i/>AD attitude transition matrix CPATT) 

This module uses the attitude ^reticulated in the 

.‘titad. p.r«.t.r «.nmion M up g,t. th. aggregated .ttitud. 

Kta ZtK 2* time gyro d.t. i. r«c.iv«d. 


algorithm and process 

The state cr.n.UUn *»' £ 

the quaternion with respect to a 8u>r lt rix which represents the partial 

last Measurement n procea , to gyto model parameters (drift, 

non-orthogonality, "'acal^fac tor and .i..lign.ent>. The .* i. “ 

1.0 llows: 


*A 


$ , e 


o 


where 


* contain, partial derivative of attitude [ 

to the value of the quaternion at the last measure 

, contain, partial derivative of attitude gu.ternion with re.pect 
to gyro model parameters* an 

1 is an identity submatrix 
itate transition matrix, $ A • 


A- 134 








6-Apr-1961 14:53:01 VAX-11 FORTRAN V2.0-2 

1 1 -Sep-1 980 11:46:08 _DBA0 : [ D 1 1 R . GC P ] P A I T . FOR : 4 


0001 

0002 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


0003 


0004 

0005 


SUBROUTINE PAT T < PHI A , P A , T A ) 

INCLUDE 'DEBoG.COM' 

• COMMON OEBUG/ I EN T E R . 1 OE BUG 

• C 

• c USER CONTROL LED PARAMETERS TO VARY DEBUG PRINT LEVEL 

• C 

. c [ NTF.fi IE 1, PRINTS WHEN ENTERS MOST SUBROUTINES 

. C I DEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

• c 

DIMENSION PHIA(16,16),PA(4,4),TA(4,12) 

RE AL*8 PA. PHI A , TA 

(;.,«*,»»...»«•.•»*•«•••«**••*»•*«•**••*•*•**•»»•*»*•*********»*•*•••»*• 

C LOAD THE TOTAL TRANSITION MATRIX 




0006 


DO 10 1=1,16 

0007 


DO 10 d = 1 , 16 

0008 

10 

PHIA( I , d ) = 0. 

0009 


DO 20 1=1,4 

0010 


00 20 d= 1 ,4 

001 1 

20 

PHIA( I ,d ) • PA ( I ,d > 

0012 


DO 30 1=1.4 

0013 


DO 30 0=5,16 

0014 

30 

PHIA(I.d) « T A ( I . d-4 ) 

00 <5 


DC 40 1=5,16 

0016 

40 

PHIAL I , I ) ■ 1 . 

0017 


RETURN 

0018 


END 


PROGRAM SECTIONS 


Name 


Bytes Attributes 


0 SC ODE 

2 SLOC.XL 

3 DEBUG 


175 

PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

68 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

LONG 

a 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 


Address Type Name 
0-00000000 PATT 


VARIABLES 

Address Type Name 
2-00000000 1*4 I 


Address Type Name 
3-00000004 1*4 I DEBUG 


Address Type Name 
3-00000000 1*4 IENTER 


Address Type Name 
2-00000004 1*4 d 


. ... - 1 inn«r nMfy 
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9 


PAT T 


6-Apr-1981 14:53:01 
1 1 -S#P"1 980 11 :46! 08 


VAX-11 FORTRAN V2.0-2 
_DBAO: [01 IR.GCPJPATT . FOR; 4 


Page 2 


ARRAYS 

Address Tyce Nam# 

AP-00000008# R* 8 P* 
AP-00 000004# R»B PMIA 
AP-0000000C# R*8 TA 


Bytes Dimension# 

128 (4,4) 

2048 ( 16 , 16 ) 

384 (4, 12) 


LABELS 

Address tab# ' 
• • 10 


Address Lao#! 
• • 20 


Address Lab# I Address Label 


• • 30 


40 


Total Space Allocated « 251 Byt#s 


COMMAND OUAL 1FIERS 

FORTRAN /LIST GCP.INOATA. MAT AB.OUTOATA. RUNG. DNAV.EPhEM 


TRUEA ,SPR ESS. OCCULT , G p ERT .GCPSEO. VISIBLE .GENENV ,TRF 


GY ROUT .RATE .BMAT ,CMA 


/CHECKS ( NO BOUNOS .OVERFLOW) 

;?7r G ;loG!^T!;G RA /" AC /OPTIMI2E /-ARMINGS /NOO.LINES /NOMACHINE. CODE /CONT INUATIONS-19 


COMPILATION STATISTICS 

Run Tim#: 0.92 seconds 

E lapsed Time: 11.55 seconds 

Pag# Faults: 307 

Dynamic Memory 1 160 pas#* 


2.5 INTEGRATE POSITION STATE (INTG) 


Tbs Navigation Stata Time Update module shall numerically integrate the 
differential equations of motion of the spacecraft and the linear differential 
equation for the state transition matrix. The fourth order Runge-Kutta-Gill 
net hod shall be used to perform the numerical integration. 

The differential equations of motion require that the inertial 
accelerations of the spacecraft be calculated. These accelerations are due to 

1. earth gravity 

2. harmonics of earth gravity 

3. solar gravity, solar pressure and lunar gravity 

The ephemeris of the moon and sun must be determined to evaluate the lunar 
gravitational effects and solar perturbations. 

The state transition matrix for the navigation state shall be integrated 
simultaneously with the equations of motion. 

This is a procedural module in that it only orders events and does not 
perform calculations. The position state is integrated to the next specified 
time needed to restrict integration errors or the measurement time, whichever 
comes sooner. The maximum next integration step sise is computed after each 
integration. 


A- 1 18 


6C1- 







i 


FILTER WORLD S 


s 

\ 


> 


f 

\ 

f 


Compute integration endpoint 
using a fixed step size (TNEXT) 


Integration interval is the 
minimum of TNEXT and TMEAS 
minus current time 


Integrate over interval 
(RKG) 




0001 
0002 
00100 
00 200 
00100 
00400 
00500 
00600 
ooroo 

00100 

00200 

00300 

00400 

0C500 

00600 

00700 

00800 

00900 

01000 

01100 

01200 

01300 

01400 

01500 

01600 

01700 

01800 

01900 

02000 

02100 

02">00 

02300 

02400 

02500 

02600 


6 ~Apr- 1 98 i 14:56:40 
11-Sep-1980 12:28:48 


0007 

0008 
0009 


VAX-11 FORTRAN .-2-0-2 
_DBA0: [01 ’R.GC- i IMG. FOR : 3 


0003 


SUBROUT 

INCLUDE 

C 

C 

c 
c 
c 
c 


0004 

0005 

0006 


I ME INTO 
’OEBUG.COM' 

COMMON /DEBUG/ JEN'E 


DEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT _EyEL 


I N'ES 
IOEBJG 


IE 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
0-10, HIGHER NUMBER VEANS MORE PRINT 


INCLUDE ’TIME. COM' 


COMMON /TIME/ T i ME . Tt.EXT . T STOP. T 1 A . OE L . T I N , 0 T N . DA T £ 0 , TZERO 
. . TVEAS. TRACK, TIS.TISN. OTA, DA TER, T PRINT, DTP RINT 

RE AL *8 T IME, TNE»T . TSTCP, T ; A .DEL . TIN.DTN , DATEO , TME AS. TRACK , T IS, 
T I SN ,DT A. r ZERC,OATER. TPRINT, OTPRINT 

THESE APE THE TIME REFERENCE FRAMES 


TIME 
TNE< T 
T STOP 
T IA 
D L 
TIN 
OTN 
DA'EO 
DATER 

tzero 
T S „EW 
TIS 
T I SN 
OTA 

tprint 

DTPRisT 

INCLUDE 1 N5TAT E -COM 1 


ATOMIC TIME SINCE INITIALIZATION < SEC > 

TIME for NEXT POSITION INTEGRATION (SEC) 
RUN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

STEP SIZE (SEC) 

POSITION INTEGRATION time (SEC) 

STEP SIZE (SEC) 

DATE of FLIGHT EPOCH (JO) 

DA TE OF 1950 EPOCH ( JO) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

REAL WORLD REFERENCE TIME (SEC) 

time for next RW POSITION INTEGRATION (SEC) 

USUALLY + del BUT + TSLEW - TIA WHEN DEL 

TOO LARGE AT MEASUREMENT TIME 

TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


0010 


COMMON /NSTATE/ X 0 ( 6 ) , X ( 6 ) , RAOM , RACE 
REAL’S XD.X.RAOM.RAOE 

POSITION state AND CONSIDERED PARAMETERS 

XD STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 

X STATE POSITION PARAMETERS (KM AND KM/SEC) 

RAOM RADIUS OF THE MOON (KM) 

RAOE EARTH OETECTABLE RADIUS (KM) 


DATA INIT/-1./ 


001 1 
0012 
Owl 3 

0014 

0015 


CALL TREG (TIN . TNEXT ) 

OTN » MIN(TNEXT.TMEAS) - TIN 

I F ( OTN . GT . . 0 1 ) CALL RXG< I N I T , OTN ) 

RETURN 

END 




C 


t 


INTG 


PROGRAM sections 


6-Apr-igei 14:56:40 VAX-11 FORTRAN V2.0-2 Page 2 

1 1 -Sep- 1 980 12:28:48 _DBA0: 1 01 1 fl . GC P ] INTG . FOR : 3 



Nine 

Bytes 

At tr 1 butes 







0 

SC ODE 

67 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

2 

Slocal 

28 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

LONG 

3 

debug 

8 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 

4 

T I ME 

136 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRt 

LONG 

5 

nstate 

1 12 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Nam* 
0-00000000 INTG 


VARIABLES 


Address 

Type 

Name 

4-00000038 

R*8 

DATEO 

4-00000030 

R*8 

DTN 

2-00000000 

I • 4 

INi . 

4-00000000 

R*8 

TIME 

4-00 000048 

R*e 

TMEAS 

4-00000010 

R*8 

TSTOP 


ARRAYS 



Address 

Type 

Nam* 

5-00000030 

R*8 

X 

5-00000000 

R*B 

XO 


Address 

Type 

Nam* 

4-00000070 

R»8 

DATER 

4 -00000-80 

R • 8 

DT PRINT 

5-0C00C058 

R *8 

RACE 

4-00000028 

P *8 

TIN 

4-00000008 

H • 8 

TNEXT 

4-00000040 

R *0 

TZERO 


Address 

Type 

Name 

4-00000020 

R*8 

DEL 

j— 00000004 

I «4 

I DEBUG 

5-00000060 

R " B 

RADM 

4-00000058 

R"8 

TIS 

4-00000078 

R* 8 

TPRINT 


Address 

Type 

Name 

4-00000068 

R*B 

DT A 

3-00000000 

I *4 

IENTER 

4-00000018 

R * 8 

T I A 

4-00000060 

R*8 

TISN 

4-00000050 

R»8 

TRACK 


Bytes Dimensions 

48 ( 6 ) 

48 (6) 


FUNCTIONS AND SUBROUTINES REFERENCED 
RKG TREG 


Total Space Allocated « 351 Bytes 


command qualifiers 

FORTRAN /LIST GC P , INDATA .MAT AS , OUT OATA , RUNG, DNAV , EPHEM, TRUEA t SPRESS t OCCULT , G PERT .GCPSEQ. VISIBLE , GENF.NV . T'lEG.GYROUT .RAT E « 0MAT , CMA 

/CHECK. ( NO BOUNDS , OVERFLOW ) 

/DEBUG* < NOSYMBOL S. TRAC EBACK ) 

/F77 /NOG.FLOATING /!« /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE CODE /CONT I NUAT IONS* 1 B 


INTO 



COMPILATION STATISTICS 

Bun Tim«: 0.74 second* 

Elapsed Time: 7.34 seconds 

Pag* Faults: 329 

Dynamic Memory: 160 pages 




2.5.1 INTEGRATE POSITION PARAMETERS MODULE (RKG) 


The Runge Kutta Gill (RKG) numerical integration method ia used to 
integrate the position state and the position transition matrix 
simulaneously . It is a fourth order technique that adequately accounts for 
the nonlinear equations of motion for orbital flight and the higher order 
terms in the transition matrix. 

The purpose of the GCPSIM navigation software is to incorporate filtered 
measurement data as artifical corrections to the state position vector. This 
requirement disqualifies multi-step techniques during the processing of 
measurement data since artificial corrections would violate the continuity of 
the inherent curve fits coefficients of these techniques. 

A second consideration for measurement processng is provisions for 
variable time steps. Frequent navigation measurements will be needed during 
convergence followed by infrequent measurements needed to maintain a specified 
error tolerance. Changing the integration step size is simple and direct with 
single step methods, but difficult with multi-step methods. Variations in 
step size for multi-step methods is accomplished by interpolations and 
extrapolations for the Variable-Step/Variable-Order Methods and by intervening 
with a single step method to define the initial values at the new time 
increment for standard multi-step methods. 

A study showed that the Runge Kutta Gill (RKG) 4th order numerical 
integration method is optimal for this application. It is self-starting, 
handles variable step sizes, and sufficiently accurate. 

The Runge Kutta Gill (RKG) method for numerically integrating differential 
equations is described here. 

The change in the value of the function during the computing interval is 
calculated by 


where *y = I (K 1 + 2(1 " k)K ? + 2(1 + k)K 3 + Kl » } k 

6 2 

k l • h • f ( t n , y n ) 
k 2 * h-f(tn + *ih, y n + 

k 3 ■ h-f(t n + *ih, yn +(-*5 + k)Kj + (1 - k)K 2 ) 

k 4 “ h.f(t n + h, y n - kK 2 + (1 + k)K 3 ) 

h * computing interval (seconds) 

t n "time of beginning of computing interval (seconds) 

y n “ value of function at beginning of computing interval 

The derivative function f shall be evaluated four times to calculate the 
change in the function being integrated during the computing interval. 
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00 100 0001 
00200 0002 
00100 0003 
00200 
00300 
00400 
0C500 
00600 
00700 

00300 0004 

00400 

00400 0005 

00400 0006 

00400 

00400 

00400 

00400 

00400 

00400 

00400 

00400 

00400 

00400 0007 

00500 0008 

00500 

00500 0009 

00500 
•j, 00500 

l 00500 
£ 00500 

un 00500 
00500 
00500 
00500 
00500 

00500 0010 

00100 

00200 0011 
00300 

00400 0012 

00500 
00600 
00700 
00800 
00900 
01 000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 


c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


6 -Apr - 1 981 14:56:49 VAX-11 FORTRAN V2.0-2 
19-Sep-1980 09.11:44 _DBA0: (D i 1R.GCP ]RKG. FOR:5 

SUBROUTINE RKG(INIT.DT) 

INCLUDE 'DEBUG. COM 

COMMON /DEBUG/ I ENTE R . 1 DEBUG 


USER CONTROLLED PARAMETERS TO VAR 7 DEBUG PRINT LEVEL 


I NT E R 
I0E8UG 

INCLUOE 'NSTATE.COM' 


IE 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
0-10. HIGHER NUMBER MEANS MORE PRINT 


COMMON /NSTATE / XD< 6 ) . X ( 6 ) , RAOM , RADE 
REAL*B XD,X , RADM, RADE 


POSITION STATE AND CONSIDERED PARAMETERS 


XD 

X 

RADM 

RAOE 


STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 
STATE POSITION PARAMETERS (KM AND KM/SEC) 
RADIUS OF THE MOON (KM) 

EARTH DETECTABLE RADIUS (KM) 


INCLUOE 'PHIN.COM' 

COMMON /PHIN/ PN ( 6 . 6 ) , PON (6.6),PHIN(S.6) . COVN (6,6) 

PON (6.6) 

REAL'S PN, PON. PHIN. COVN, PON 

THESE ARE THE NAVIGATION TRANSITION AND COVARIANCE ARRAYS 


PN 

POSITION 

STATE TRANSITION MATRIX 

PDN 

« 

DERIVATIVE OF TRANSITION MATRIX 

^ri 1 f. 


AGGREGATE TRANSITION MATRIX 

COVN 

• 

NEW COVARIANCE MATRIX 

PON 

* 

PREVIOUS COVARIANCE MATRIX 


INCLUOE 'TIME.COM' 


COMMON /TIME/ TIME . TNEXT , TSTOP, T IA.DEL .TIN, OTN.DATEO.TZERO 

.TMEAS. TRACK , T I S . T I SN , OT A , DATE R . TPRI NT . OTPR INT 
REAL'S TIME. TNEXT , TSTOP . T 1 A , DE L . T IN.OTN , DATEO , TMEAS , TRACK . TIS 
• TISN.OTA.TZERO.DATER.TPRINT.OTPRINT 


these are the time reference frames 


time 

TNEXT 

TSTOP 

TIA 

D . L 

TIN 

OTN 

OATEO 

OATER 

T ZERO 

TSLEW 

TIS 

TISN 


ATOMIC TIME SINCE INITIALIZATION (SEC) 

TIME FOR NEXT POSITION INTEGRATION (SEC) 
RUN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

' ‘ STEP SIZE (SEC) 

POSITION INTEGRATION TIME (SEC) 

' ’ STEP SIZE (SEC) 

DATE OF FLIGHT EPOCH (JD) 

DATE OF 1950 EPOCH (JD) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND AC9UIRE (SEC) 

REAL WORLO REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 


Page 


VAX-11 FOPTRAN V2.0-2 
_DBAO: [Cl 1R.GCP]RKG. FOR ; 5 


P«0* 



( 

j- 


RAG 


02200 


• c 

DTA 

02300 


• c 


02400 


• c 

TPRINT 

02500 


• c 

DTPRINT 

02600 


• c 


00600 

0013 


INCLUDE 'UPDT.COM' 

00700 


• c 


00700 

0014 

• 

COMMON /UPOT/ QN< 6 ) , QA 

00700 

0015 

• 

REAL*8 ON.QA.Q.QOOT 

00700 


• c 


00700 


• c 

STATE STIMAT 

00700 


• c 


00700 


• c 

ON 

00700 


• c 

0* 

00700 


- V 

0 

00700 


• C 

ODOT 

00700 


• c 


00700 

0018 


DIMENSION AA ( 4 ) , BB ( 4 ) , 

00800 

0017 


RE AL *8 DT.T.M. AA.B3.CC 

00900 

0018 


DATA AA / . 5. .292893. 1 . 

01000 

0019 


DATA 88 /2.,1. , 1 . , 2 . / 

01100 

0020 


DATA CC / . 5, .292893. 1 . 

01200 

0021 


I F < INIT. EQ . 0 ) GO TO 20 

01300 

0022 


DO 10 I > 1 , 6 

01400 

0023 


RNDOF 1 ( I ) » 0. 

01500 

0024 


DO 10 d> 1 ,6 

01600 

0025 


RNDOF2 ( I.d) ■ 0. 

01700 

0026 

10 

RND0F3( I . J) * 0. 

01800 

0027 


INIT « 0 

01900 

0028 

30 

DO 50 K < 1.4 

02000 

0029 


CALL DNAV< TIN. X , XD.K ) 

02100 

0030 


CALL PON AV ( PN , PON) 

02200 

0031 


IFIK.EO. 1 -OR.K . 0-3) T 

02300 

0032 


DO 30 I >1.6 

02400 

0033 


T • AA ( K )*(X0< I )-88( K) 

02500 

0034 


W * X(I) 

02600 

0035 


X( I) « X ( I ) +T« DT 

02700 


c 

T > ( X ( I )-W)/0T 

02800 

0036 

30 

RNDOF 1 ( I ) « RNDOF 1 ( I ) 

02900 

0037 


DO 40 I > 1 . 6 

03000 

0038 


DO 40 J« 1 .6 

03100 

0039 


T « AA ( K ) • ( PDN ( I . d)-BB 

03200 

0040 


M « PN ( I , J ) 

03300 

0041 


PN (I.d) - PN{ I ,d)«T*DT 

03400 

0042 


T • <PN( I ,d)-M l/OT 

03500 

0043 

40 

RND0F2 (I.d) ■ RNOOF 2 1 I 

03600 

0044 


DO 50 I . 1.6 

03700 

0045 


00 SO d > 1 . 

03800 

0046 


T • A A ( 

03900 

CC*7 


W « 0(1 

04000 

0048 


0(1. d) 

04 100 

0049 


T • <Q( 

OW.’OO 

OOSO 

SO 

RNOOF 3 ( 

0431" 

0051 


RETURN 

04401 

0052 


END 


6-Apr-1981 14:56149 
19-Sep-1 980 09 ' 1 1 :44 

USUALLY ♦ DEL BUT ♦ TSLEW - TIA WHEN OEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT <SEC) 

INCREMENT ON TPRINT (SEC) 


(16) ,0(6,6 ) ,QOOT (6,6) 


ION PARAMETERS 

NAV. OYN. NOISE COVARIANCE DIAGONAL 
MIN. VALUES FOR ATT. COVARIANCE DIAGONAL 
CONTRIBUTION TO NAV. COV. FOR DYN. NOISE 
DIFFERENTIAL OF 0 

CC ( 4 ) , RNDOF 1 (8) , RNOOF2 (6,6) , RNOOF3(6,6) 
.RNDOF1 , RNDOF2 , RNDOF3 

707 107.. 16686*7/ 

7071 07.. 5/ 


IN « TIN ♦ DT/2 
•RNDOF 1 ( I ) ) 


♦ 3 . *T - CC(K)*XD(l) 


( K ) • RNOOF 2 ( I , d ) ) 


.d) •*■ 3. »T - CC( K ) »PDN ( I , J ) 


K)*(0DO1 I 1 ,d) - BB(K) • RNOOF 3 ( 1 , J ) ) 

.J) 

• 0< I.d) ♦ T*0T 
I.d) - W)/DT 

I.d) • RNDOF3( I , J ) ♦ 3 . »T - CC ( K ) • ODOT ( I , J ) 


RKG 


VAX-11 FORTRAN V2.0-2 
_DBAO: [01 1R.GCPJRKG. FOR: 5 


P«0« 3 


6-Apr— 1981 1 4 '• S6t 49 
1 9-Sep- 1 980 09:n:44 


PROGRAM SECTIONS 




0 SC ODE 

2 $ LOCAL 

3 OE BUG 

4 NS TATE 

5 PM IN 

6 TIME 

7 UPOT 


Bytes 

Attr. but** 







455 

PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

nomrt 

LONG 

780 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEAE 

RD 

WRT 

OUAD 

8 

PIC 

OVR 

REL 

G8L 

SHR 

NOEXE 

RD 

WRT 

LONG 

1 1 2 

PIC 

CVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

1 440 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

136 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

752 

PIC 

OVR 

REL 

GBL 

SMR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Nam* 

0-00000000 RAO 


VARIABl ES 

Address 

6-00000038 
6-00000068 
3-00000004 
2-000002E8 
6-00000018 
6-00000060 
6-or ooooso 


Type Nam* 

R*8 DATEO 
R*8 OTA 

1*4 ioE8ua 

1*4 K 
R*S TIA 
R*8 T1SN 
R*0 TRACK 


Address 

6-00000070 

6-00000030 

3- OOOOCOCO 

4- 0G0C0068 
6-000C 0 000 
6-00000048 
6-00000010 


T ype Nam* 

R *8 OATER 
R*8 DIN 
1*4 1ENTCR 
R*8 RACE 
R*a time 

r*8 tmeas 

R*8 TSTOP 


Address 

Type 

Nam* 

Add-ess T 

ype 

Name 

6-00000020 

R* 8 

DEL 

AP-000000088 

R *8 

DT 

6-00000080 

R* 3 

DTPRINT 

2-GCC002EO 

1*4 

1 

AP— 00 000004P 

1*4 

INI T 

S-000002E4 

1*4 

J 

4-00000060 

R*B 

RADM 

2-C0000200 

R*8 

T 

6-00000028 

r*b 

TIN 

6-00000058 

R*a 

TIS 

6-00000008 

R*8 

TNEXT 

6-00000078 

R*8 

T PRINT 

6-00000040 

r*b 

TZERQ 

2— 000002D8 

R *8 

M 


ARRAYS 

Address 

2-000C0000 
2-00000030 
2-00 000040 
5-00000360 
5-000001 30 
5-00000240 
5-00000000 
5-00000480 
7-00000090 
7-00000033 
7-00 000 1 DO 
7-00000000 
2-00000060 
2-00 000090 
2-000001 BO 
4-00000030 
4-00000000 


Type 

Name 

Bytes 

D i mens i on* 

R*8 

AA 

32 

<4) 


R*8 

SB 

32 

(41 


R* 8 

CC 

32 

<4 | 


R*8 

COVN 

289 

(6. 

61 

R*8 

PON 

280 

(6. 

6) 

R*8 

PMIN 

208 

<6. 

6) 

R*8 

PN 

2ea 

(6. 

61 

R*a 

PON 

208 

(6. 

6) 

R • 8 

0 

288 

(6. 

6) 

R*0 

QA 

1 20 

(161 

R*8 

QOOT 

288 

<6. 

6) 

R*8 

ON 

48 

(6) 


R* 8 

RNOOF1 

48 

(6) 

6) 

R*8 

RNOOF2 

2 es 

16. 

R*8 

RNDOF3 

268 

(6, 

6) 

R*8 

X 

43 

(6) 


R*a 

XD 

48 

< 6 ) 





OKO 6- Apr- 1 981 14:56:49 WAX-11 FORTRAN V2.0-2 Fag* 4 

1»-S*p-1980 09 : 11:44 _obao:[oiir.gcp]rko.for:5 

LABFLS 


Address 

Labe l 

Address 

Labe 1 

Address 

Label 

Address 

Labe l 

Addrtts 

Label 

• • 

10 

0-0000 003E 

20 

• • 

30 

• • 

40 

• • 

SO 


FUNCTIONS ano subroutines referenced 

DNAV PON AV 


Total Space Allocated • 3683 Byte* 


COMMAND QUALIFIERS 

FORT WAN /LIST GCP. INOAT A. MAT AB. OUT OATA. RUNG, DNAV.EPME'I, TRUEA, SPRESS, OCCULT, GPERT.GCPSEQ. VI SI BLE.GENENV, TREG.GVROUT. RATE. BRUT, CMA 

/CHECK. (NOBOUNDS .OVERFLOW) 

/DEBUG- I N0STM80L S. TRAC E8ACK) 

/F7T /NOG FLOATING /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE _COOE /CONT INUATIONS-19 


COMPILATION STATISTICS 


Run T ima: 

E I apsed Tima: 
Page Faults: 
Dynamic Memory: 


2.40 seconds 
28-11 seconds 
381 

ISO pages 


2.5. 1.1 COMPUTE SOLAR/LUNAR EP HEME RIDES (EPHEM AND TRUEA) 


The soon and aun poaitiona art needed to compute gravitational 
ptrturbationa, and atar and lunar liab occultationa. Thia nodule ia uaed for 
both actual and filter calculationa and for a given tine in Julian daya 
conputea both poaitiona in EC1 coordinatea to within 1 degree of arc. 


The epheneridea of the aun and the awon are baaed upon the fundanental 
orbital eleawnta for theae bodiea given in the Explanatory Supplenent to the 
Nautical Alnanac, pp. 98-107. Theae elenenta are expreaaed aa aecond and 
third degree polynoniala in tine t4iere the independent variable T ia neaaured 
in Julian centuriea of 36525 daya. The epoch for both orbita ia January 0.5 
E.T. 1900. 



Ecliptic Plane 


Equatorial Plane 


Mean Orbital Elenenta of the Sun and Moon 


Mean Orbital Elenenta of the Moont 


(- 

r< • 


The nean longitude of the noon, meaaured in the ecliptic from the 
mean equinox of date to the mean aacending node of the lunar orbit, 
and then along the orbit; 

The mean longitude of the lunar perigee, meaaured in the ecliptic 
from the mean equinox of date to the mean ascending node of the lunar 
orbit, and then along the orbit; 

The longitude of the mean aacending node of the lunar orbit on the 
ecliptic measured from the mean equinox of date; 


A-149 


• ■ Hie constant of eccentricity; 

Y - Sin i/2, where i i. the constant of inclination; 

H( " lhe •< uatori *l horizontal parallax at 60.2665 equatorial radii 

( ' 2 70° 26' 02! '99 + 1336 r 307°52 '59! ’31T - 4!’08T 2 + 0!'0068T 3 

F' - 334° 19' 46! '40 + lin09°02'02! '52T - 37!'17T 2 - 0!’045T 3 

" 259°10*59! , 79 - 5ri34°08’31 ! *23T + 7.”48T 2 + 0!’008T 3 

e - 0.054900489 

r " 0.044886967 (i - 5°145396366) 

n ( " 57 *02 ! *70 (n - 0.0165932496 radians) 

Mean Orbital Elements of the Sun, 


L - 

r - 

e ■ 
e ■ 

n e - 

L - 

r - 








geometric meen loragituae 
from the mean equinox of date 

Peri8M in “• fr«« tt 

The mean eccentricity 


The mean obliquity of the ecliptic 
Horizontal parallax 

279°41'48!’04 + 129602768! ' 13T + 1!'089T 2 
281 °13* 15! '00 + 6189! '03T + 1 ! * 63T 2 + 0!'0126T 2 


e * 


0.01675104 - 0.00004180T - O.000000126T 2 
e = 23°27'08!'26 - 46!'845T 2 - 0!'0059T 2 + 0!’00181T 3 

n© - 8! '80 OI 0 * 4.26624E - 5 radians) 

th rough the 'fol lowing°chain rf^^^nar^a^fr^aon. 8 : CO,DPUted 


[""] ' NJ [ Q -zJ f-xl f(v <+ , 

“C ? -Z I 

[ol 

5>un position vector (ECI) 

[R»] ■ [e-x] [(v 9 + “e)- 2 ] 

>oo' 

L l 

J t 



A- 150 




where 


v ;| * The true anomaly of the moon computed from a literal expansion 

in terms of the sine function of the mean anomaly, M and the 
eccentricity to the seventh degree; 

o> ( - The argument of perigee of the moon's orbit; 

and similarly for and wq. 

These elements are determined by the following process: 

M( - <T - r’ 

Mq - L - r 

Thence, for each respective orbit, 

v - M + (2e - 1 e 3 + 5_ e 5 + 107 e 7 ) Sin(M) 

4 96 4608 

+ (5 e 2 - U_ e 4 + n__ e 6 ) Sin(2M) 

4 24 192 

+ 03 e 3 - 43 e 5 + 95 o 7 ) Sin(3M) 

12 64 512 

+ 003 e 4 - 45J_ e 6 } Sin(4M) 

96 480 

Furthermore, the arguments of perigee are determined, 
u) f = r ' - q 
co 0 = r' 

and finally the radius vectors for the sun and the moon are computed, 
a(l - e 2 ) 

r * — 1 

1 + eCosv 

where the orbit mean distances, a, are obtained fiom the respective horizontal 
parallaxes, 

a( * RE/n<f 

ag » Re/Hq 

■ 384421.87 km 

ag = 149605590. km 


A— 151 


COMPUTE SOLAR/LUNAR EPHFMERIS (EPHEM) 



Figure A-25 


A-l‘j2 


0001 


0002 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


6-Apr-l981 14:46:52 
1 1 -Gep-1 980 11 : 15: 24 


C 

C 

C 

C 

C 


c 

c 

c 


SUBROUTINE EPWEM (T.RM.RC) 
•••••••••••• lunar SOLAR EPhEMERIS data 




input parameter 

T « TIME IN JULIAN OA/S SINCE JO 0.0 
OUTPUT PARAMETERS 

RO * RADIUS VE C TOT (EARTH CENTER TO SUN) — 
RM - RADIUS VECTOR < EARTH CENTER TO MOON) — 


ECI COORDINATES (KM) 
EC I COORDINATES (KM) 


0003 


INCLUDE 

• C 

• c 

• c 

• c 

• c 

• c 


'DEBUG. COM’ 

COMMON / DEBUG/ I EN T E R , l DEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

I NTCR IF 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
IDEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 


VAX-11 FORTRAN .2.0-2 
_DBAO : [D11R.GC!- ] EPhEAT . FOR ; 5 


0004 

0005 

0006 
0007 


0008 


0009 

0010 
001 1 

0012 

0013 

0014 
00 IS 

0016 

0017 

0018 

0019 

0020 
0021 

0022 

0023 

0024 

0025 

0026 

0027 

0028 


0029 

0030 


C 

c 

c 


DIMENSION R0( 3 ) . RM< 3 ) 

REAL'S am AO.c . C I M . CO . C V* . 0 , EM , EO , ER , GM . GO , LM . 10 . MM. MO . OM . RMS , 
ROS, SE . S IM, so , SVW, T . T1 . T2, VM, VO, VMM, VWS , RM . RO 
DATA CIM, SIM/. 995963 ,--089763/ 

DATA AM, AO, em/384421 .87. 1 .496055956, .054900489/ 

0 * .0001 X DAYS SINCE 1900 


C 

c 


c 


c 


c 


c 

c 


0* 1 . E-4 • ( T-241 5020. ) 
•*•**• MOON EPHEM RIS 
BEFEHENCE FOR EQUATIONS 
LM = 4 .719 96657 1 66-0- ( 
GM = 5 . 835151538 9+D*< 1 
0M=~4. 52360151 484*0* 
•••*•• SUN EPHEMERIS 
LO* 4.88162793797*0* 
G0=4. 908 229461 03*D* ( 
£0=0.016751 04- 0* ( 1 . 1 
EP=-0. 40931974744*0* 
•**•** ELLIPSES PROPERT 
MM = LM-GM 


LV AND OM BE LOW , P. 107 EXPLANATORY SUPPLEMLNT 
2299. 7 150294-D*( 1 . 483S29B6E-6- D*6 . 806784E- 1 0 ) ) 
9.44368-0*11 . 35071 03E-5+ D»4 . 53 7856E-9 ) ) 

( 9.242 2029423-0* (2. 71747764E-6+0*8. 72665E- 10)) 

( 1 .7202791 266E+2+0*3 . 95666 1 4E- 7 ) 

8.21 49 855364 £-3*0* ( 5 . 9 1 66662 E - 7+D* 1 . 22173E-9) > 
444E-5*0*9.4E-9) 

( 6^2 1 7909993 E-5*0* ( 2 . 1 46755E-9-D*1 . 79769E- 10)) 


CALL T RUE A ( MM . EM . VM ) 

RMS* AM* ( 1 .-EM* EM ) / ( 1 .+EM*COS<VM) ) 

MO * LO-GO 

CALL TRUEA(MO. EO, VO) 

ROS* AO* ( 1 .-EO* EO ) / ( 1 . *EO*COS(VO) ) 

••••** AXES transformation 

VWM.-GM-OM-VM 
CVN » COS(VWM) 

SVM « SIN(VWM) 

CO « COS(OM) 

SO • SIN(OM) 

CE * COS(EP) 

SE * SIN(EP) 

••*•*• TRANSFORM FROM LOCAL to ECI COORDINATES 

•••••• MOON 

RM(1) « RMS*(CVW*CC-CIM*SVN*SO) 

T 1 ■ -RMS* (CVW *SO*C I M*SVM*CO) 


Pmgc 


-154 


EPHEM 


0031 

T2 * 

RMS »S IN* S VW 

0032 

RM ( 2 ) 

•- T1*CE+T2*SE 

0033 

RM(3) 

* T2*CE- T 1 »SE 


C •*••»* SUN 

0034 

vws=- 

( VO lGO ) 

0035 

cvw • 

COS(VWS) 

0036 

s vw » 

SIN( VWS) 

0037 

R0(1) 

* ROS*CVW 

0038 

RO ( 2 ) 

* -ROS*CE*SVW 

0039 

RO( 3) 

* ROS*SE*SVW 

0040 

RETURN 

0041 

END 



6-Apn-1981 14:46:52 VAX-11 FORTRAN V2.0-2 
tl-Sep-1900 11:15:24 _DBAO: [01 1 R. GCP JEPHEM. FOR : 5 


Page 


PROGRAM SECTIONS 


Na me Bytes Attributes 


0 

JCOCE 

828 

PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

2 

SLOCAL 

304 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RO 

WRT 

QUAD 

3 

DEBUG 

8 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 EPHEM 


VARIABLES 


Address 

Type 

Name 

Address 

Type 

Name 

Address 

T ype 

Name 

Address 

Type 

Name 

2-00000000 

R*8 

AM 

2-00000008 

R *8 

AO 

2-00000010 

R*8 

CE 

2-00000018 

R *8 

CIM 

2-00 000020 

R*8 

CO 

2-00000028 

R * 8 

CVW 

2-00 000030 

R*8 

D 

2-00000038 

R • 8 

EM 

2-00 000040 

R*8 

EO 

2-00000048 

R *8 

EP 

2-00000050 

R*8 

GM 

2-00000058 

R *8 

GO 

3-00 000004 

1*4 

1 debug 

3-00000000 

I *4 

I ENTER 

2-00000060 

R*8 

LM 

2-00000068 

R *8 

LO 

2-00000070 

R*a 

MM 

2-00000078 

R *8 

MO 

2-00 OOOOBO 

R*8 

OM 

2-00000088 

R • 8 

RMS 

2-00000090 

R*a 

ROS 

2-00000098 

R*8 

SE 

2— 00 OOOOAO 

R*8 

SIM 

2-000000A8 

R *8 

SO 

2-00 OOOOBO 

R*a 

SVW 

AP-000000040 

R*8 

T 

2-000000 B8 

R*8 

T 1 

2-COOOOOCO 

R»8 

T 2 

2-OOOOOOC8 

R*8 

VM 

2 -00000 0D0 

R *8 

VO 

2— 000000D8 

R*8 

VMM 

2-OOOOOOEO 

R * 8 

VWS 


ARRAYS 


Address Type 

Name 

Bytes 

Oi mens ions 

AP— 00 000008P R*8 

RM 

24 

(3) 

AP— 00 oooooce R*B 

RO 

24 

(3) 


Page ^ 


EPHEM 


6-Apr-19B1 14=46:52 
1 1 -Sep-1 900 11 =15=24 


VAX-11 FORTRAN V2.0-2 
_0B*0= [01 1R.GCP]EPHEM.F0R; 


5 


FUNCTIONS and subroutines referenced 

MTHSDCOS MTHSDS1N TRUE* 

Total Space Allocated » 1 1 40 Bytea 


COMA'AM D QUALIFIERS 

fortran /list gcp. indata. matab.outoata. rung. onav. ephem. truea 

/check*! no BOUNOS .OVERFLOW) 

/OEBUG*(NOSYMBOLS.TRACEBACK) /WARNINGS /noo_lines 

/ F77 /NQG_FLQAT 1NG / I A /OPTIMIZE /«» N ™‘ 


, SPR ESS. OC CULT ,G PERT .GCPSEO. VISIBLE, GENENV 

/NOMACHINE^CODE /CONT INUAT IONS- 1 9 


TREG.GYROUT.RATE.BMAT ,CMA 


COMPILATION STATISTICS 


Run Time: 
Elapsed Time: 
Page Faults - * 
Dynamic Memory! 


2.07 seconds 
16.69 seconds 
363 

160 pages 


h.1iw sa w l±* l* 't*» »**' m 


6~Apr-1981 14:47M0 

11 -Sep-1 980 12:94:46 


VAX-11 FORTRAN V2.0-2 
_DBA0: [ D 1 1 R . GCR ] T RUE A . FOR : 5 


Page 


0001 


0002 

0003 

0004 

0005 

0006 

0007 

0008 

0009 

0010 
0011 
0012 
0013 


0014 

0015 


C** 

C 

C* • 


SUBROUTINE T RUEA ( M , E , V > 

THIS ROUTINE COMPUTES ThE^ 
**’rEAl* 8 E,E2.E3.t.4.S5,-6,E7 

E2 = E *E 
E3--E*E2 
£4* E * E3 
E5 - t *E4 


TRUE ANOMALY 
,M,S2M,S3M,S4M,SM. V 


*••*-**•***•••*•• 




E6 - E 
E7 = E 
SM = S 
S2M-: 
S3M = 
S4M = 
V sM + 

1 -0. 

2 0.1 
RET U 
END 


• E5 
•E6 
IN(M) 

SINl 2 . »M) 

S IN ( 3 . *M) 

SM^>( 2 ! *E— *25*E3eO. 05^083 333* E5*0^023220486*E^£^S2M*O^25*E2^ 

85546875* E7^ +S4M*? tto729 ' 6667 • E4-0 . 9 395833 33* E6) 

RN 


PROGRAM SECTIONS 


Name 

0 SCOOE 
2 SLOCAL 
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2 *5. 1.2 COMPUTE SOLAR PRESSURE MODULE (SPRESS) 


Solar radiation pressure is an external force acting on the spacecraft and 
must be included in the equations of motions. This force is calculated with 
the assumption that the satellite is symmetric, the photon flux is constant, 
and the sun behaves as a point source of photons. If the sun is occulted by 
either the moon or the earth, the acceleration is aero. 

The acceleration of the spacecraft caused by solar radiation impinging on 
the exposed vehicle body is equivalent to the change in momentum of the 
incident radiation, divided by the mass of the spacecraft. The change in 
momentum is equal to the product of the momentum per photon P 0 , the photon 
rate peraecond per unit area K, the exposed area projected to a flat surface 
in the direction of the radiation A, the reflectivity of the surface K^, and 
the unit vector from the spacecraft to the sun Rq. The acceleration is the 
change in momentum divided by the mass of the spacecraft, m. 

•r - Po K ♦ A • R # / m 

Assuming that the spacecraft operates at a constant distance from the sun the 
value of K is constant and may be combined with P Q , 

P - P 0 * K 

For a spherical or near spherical spacecraft the factor (A/m) may be 
considered to be constant; furthermore a single value for may be used for 
most vehicles. 

The vehicle will not experience radiation 
pressure from the the sun if it is haded by the 
earth or the moon. Mo shading will occur if 
either 1) the occulting body and the sun are on 
opposite hemispheres from the spacecraft, i.e., 
the dot products of the unit vectors from the 
spacecraft to these bodies is negative; or 2) 
the radius of the occulting body is less than 
the perpendicular from the spacecraft-sun 
direction to the center of the body. 

The procedure used in this module is shown in Figure A-26 . Compute 
the unit vectors from the spacecraft to the sun, Rg, and to the earth, Re, 
and moon, R q ( see algorithms SE-1 and ST-4). Do not compute radiation 
pressure if 
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*b • *« < 0 (b ■ earth or moon) 


rj, < Rb Sing 


8 * Cos" 1 |Rb*Rs 


If neither of the above conditions ia met the spacecraft is irradiated by the 
sun and radiation pressure should be computed 


x ■ PK^ • (— ) *Rs Km/sec 2 


P * A. 59 x 10~9 ((Newtons) /m) (Km/m) 

K! - 1.7 

A/mv * exposed vehicle area in m 2 /vehicle mass in kg 
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COMPUTE SOLAR RADIATION PRESSURE 



Figure A- 26 
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(3 + 3qs + qs 2 j 
"‘l 8 1 +(1 + qe) 3 2 
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and similarly for f (qm) » qm» end 008 atn * 
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And, Q = R**2/RS**2 - 2ABS(R/RS) COS (ALPHA) 


ALPHA - R DOT RS / (ABS(R) * ABS(RS)) 


Figure A-27 
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Address Type Nam* 
0-00000000 R»8 FQ 


VARIABLES 


Address Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

2-00 000008 R*8 

CA 

2-00000010 

R * B 

Q 

2-00000018 

R»8 

RM 

ARRAYS 








Address Type 

Name 

Bytes 

Di mens ions 




A P—00 0000048 R»B 

R 

24 

24 

(3) 

13) 





AP-00 000008 • R*8 

RS 






Address Type Name 
2-00000020 R*B RSM 


FUNCTIONS AND SUBROUTINES REFERENCED 
VOOT VMAG 


Total Space Allocated ■ 278 Bytea 


6 -Apr- 1 98 1 15:06:32 
30-Sep- 1 980 07:24:35 


VAX-11 FORTRAN V 2.0-2 
_DBA0: [01 1 R . GC P ] FQ . FOR ;6 


Rage 


FQ 


command qualifiers 


fortran /list gc p. indata, mat ab.outoata, rung 


, DNAV ,EPH EM, TRuEA ,SPR ESS, OCCULT , G p ERT , gcpseq . visible .genenv ,treg ,gy rout .rate.bmat ,cma 


/CHEC1=( NO BOUNDS .OVERFLOW) 

/OEBUG/^NOSYMBOLS^TR cEB C / ^ pTIMI2E / WARN INGS /nod.lines /nomachine.code /C0NTINUATI0NS.19 


COMPILATION STATISTICS 

Run Time: 0.70 seconds 

Elapsed Time: 11.55 second* 

Pag* Faults: 332 

Dynamic Memory: 160 page* 




r 


( 


2. 5. 1.4 COMPUTE NAVIGATION STATE PARTIALS (PDNAV) 

The Poaicion State Tranaition Matrix ia a 6 x 6 matrix of partial 
derivativea which relate email changea in the poaition and velocity atate at 
one time to changea in the poaition and velocity atate at a later time. 

The atate tranaition matrix ahall be calculated by integrating the 
linear differential equation 

4>n “ f 4>n 

with the initial condition ^(tg, tg) ■ Identity (6 x 6) where the non-zero 
elements of F are given by 


*41 


- y 

R 3 


1 - 3(xi) 2 
R 2 


-3J 2 (Re) 2 . £ 

2 R R 3 


35( X] • Xq ) 2 - 5( Xl 2 + Xr) 2 ) + 1 
R 2 R 2 


F 4 2 = y 

'3_xi;x ? ~ 

- l J 2 (.R e ) 2 ■ y (5xi • x?) 

’ 7 <£^ 2 - 1' 
R 

R 3 

R 2 

2 R R 3 R 2 

f 4 3 * y 

jx i;x.. 

- 3Jp (Re) 2 . y (5 xt • x?) 

>(xa) 2 - 3 
. R 

R 3 

L R 2 J 

2 R R 3 R 2 


F 5 1 = F 42 

F 52 * - jJ 


F 5 3 = 

f 6 1 " 
f 62 = 


R 3 


y 

R3 


F 4 3 
F 5 3 


1 - 3(x?) 2 
R 


“ 2 (M) 2 ■ H |~35( x ? . xQ - 5( x ? 2 + x, 2 ) + 1 


3x ? • x-tl - 3J ? (Re) 2 . y (5xo -xq) f7(xs) 2 - 3 
1 2 R 13 , -jj? 


F 63 = - y 

1 - 3(3^) 2 

- 3J 2 (Re) 2 , y [ 35 (x^) 4 - 30 (xjj) 2 + 3 

R 3 

R 

2 R R 3 [ R R 


where 


*e “ equatorial radius of earth 


A— 171 



COMPUTE NAVIGATION STATE PARTIALS 


COMPUTE STATE PARTIALS - 2 ZONAL HAR- 
MONICS 


COMPUTE THE TRANSITION MATRIX DERIVATIVES 


BY MULTIPLYING TRANSITION MATRIX BY 
STATE PARTIALS MATRIX 


Figure A-28 


A- 172 


6-Api — 1981 14 : 57:18 
1 1 -Sep-1 980 1 1 : 47: 39 


VAX-11 FORTRAN L2.0-2 
_DBAO: [01 1 R . GC P]PDNAV.F0R;4 


Page 


0001 

0002 

0003 

0004 
00100 
00200 
00300 
00400 
00500 
00600 
00700 


0005 


0006 

0007 

0008 


0009 

0010 

001 1 


0012 

0013 

0014 


SUBR 

DIME 

REAL 

INCL 


OiriNE PDNAV ( PN. PON | 

NS ION PN16.6 ) ,P0N{ 6.8) 

*8 F1,F2.X2R,XYR.XZR.Y2R , YZR . Z 2R . PON , PN 
UDE '0EBUG.COM' 

COMMON /OEBUG/ I ENT E R . 1 DEBUG 

USER CONTROLLED PARAMETERS TO VARY OEBUG PRINT l EVE w 


I NTER 
IOEBUG 


IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
0-10, HIGHER NUMBER MEANS MORE PRINT 


INCLUDE 'CONST.COM' 

COMMON /CONST/ A TM . R BV , RBE , RBO , R E2 , RM2 , UM, US , UE , J2 , J3 , J4 , DTU , PK 1 
RE A L*8 A TM , R BV .RBE . RBO , R E2 , RM2 , UM, US . UE , J2 , J3, J4 , DTU.PK1 

PROGRAM CONSTANTS 

ATM S/C AREA TO MASS ^ATIO (METERS/KG) 

RBM OBSTRUCTION RADI'S OF THE MOON (KM) 

RBE “ * EARTH (KM) 

RBO " " SUN (KM) 

R 2 SQUARE OF THE EAR HS RADIUS (KM 2) 

RM2 " LUNAR RADIUS (KM 2) 

UM LUNAR GRAVITATION CONSTANT (KM 3/SEC 2) 

US SOLAR ■ 

U EARTH 

J2.J3.U4 ZONAL GRAVITATIONAL HARMONIC TERMS 
DTU REGULARIZED TIME STEP SIZE (SEC) 

PK I SOLAR PRESSURE CONSTANT 

INCLUDE 'RVEC.COM' 

COMMON /RVEC/ R(3),RM<3).RO(3). RSM( 3) , RSO( 3 ) , R5S( 3 ) , SB ( 3 ) 

. , RA , R 2 , R3 , R SMA , RT G{ 3 ) 

RE AL*3 R .RM.RO.RSM.RSO.RSS , SB , RA , R2 . R3 . RSMA , RTG 

THESE ARE RADIUS VECTORS IN EC! AND BODY COORDINATES 

R EARTH CENTER TO S/C - EC I (KMl 

RM " MOON - EC I (KM) 

RO " SUN - EC I (KM) 

RSM SPACECRAFT TO MOON - ECI (KM) 

RSO “ SUN - ECI (KM) 

RSS EARTH CENTER TO STAR - ECI 

RA ABSOLUTE OF VECTOR R (KM) 

R2 SQUARE OF RA ( KM 2) 

R3 CUBE OF RA (KM 3) 

RSMA ABSOLUTE OF RSM (KM) 

INCLUDE 'GFPART.COM' 

COMMON/GFPART/ FA ( 4 . 4 ) . E A ( 4 , 1 2 ) , FN(6, 6 ) 

RE AL»B FA.EA.FN 

MEASUR MENT ANO STATE PARTIALS 


FA 

EA 

FN 


ATTITUDE STATE PARTIALS 

* CONSIDERED PARAMETERS PARTIALS 

• STATE PARTIALS 


Pag* 2 
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• 

c 



0015 


c 

INCLUDE ' NSTAT E . COM ' 


0016 

• 


COMMON /NSTATE/ XD<5). 

X ( 6 ) . RADM.RADE 

0017 

• 

r 

REAL’S XO.X.RADM.RAOE 



• 

• 

V 

c 

Q 

POSITION STATE AND CONSIDERED PARAMETERS 


• 

c 

XD 

STATE DERIVATIVES (KM/SEC ANO KM/SEC/SEC) 


• 

c 

X 

STATE POSITION PARAMETERS (KM AND KM/SEC) 


• 

c 

RAD* 

RADIUS OF THE MOON (KM) 


• 

• 

c 

c 

RADE 

EARTH DETECTABLE RAOIUS (KM) 

0018 

• 

c 

r 

INCLUDE 'ARRAVS.COM' 


0019 

• 

v> 

COMMON / ARRAYS / T1<3>. 

T2(3).T3(3),T4(10) ,T11 (3.3). T33<3,3) 


• 


. , T44, 4,4) . T66(6,6 ) ,T?7<6.6) . TS(4) ,T6(4) ,T7(4) 

0020 

• 

r 

REAL’S T 1 .T2.T3.T4.T 1 1 

, T 33 , T44 , T 66, T77 , T5 , T6 . T7 


• 

• 

w 

c 

c 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 


• 

c 

T 1 - T 4 

SINGLE DIMENSION ARRAYS 


• 

c 

Til - T77 DUAL DIMENSIONED ARRAYS 


• 

c 

r 

T 1 ! 

DUAL ARRAY; OFF DI AG IONA L SET TO ZERO 

0021 



INCLUDE 'UPOT.COM' 


0022 

• 

V 

COMMON /UPOT/ 0N(6I.0A(16) ,iJ(6.6),ODOT(6,6) 

0023 

* 

Q 

REm>.’8 QN.QA.O.ODOT 



• 

C 

STATE STIMATION PARAMETERS 


• 

c 

ON 

NAV. DYN. NOISE COVARIANCE DIAGONAL 


• 

c 

QA 

min. VXLUES FOR ATT. COVARIANCE DIAGONAL 


• 

c 

0 

CONTRIBUTION TO NAV. COV. FOR DYN. NOISE 


• 

• 

c 

f 

ODOT 

DIFFERENTIAL OF Q 

0024 



Ft « UE/R3 


0025 



F2 * 1 .5»F1’J2’RE2/R2 


0026 



X2R « X( 1 )’X( 1 )/R2 


0027 



Y2R « X ( 2 ) *X ( 2 ) /R2 


0028 



22 R « X( 3 ) * X ( 3 )/R2 


0029 



XYR * X ( 1 )’X(2),R2 


0030 



XZR « X( 1 ) * X ( 3 )/R2 


0031 



YZR » X( 2|’X( 3 )/R2 


0032 



FN(4 . 1 ) > FI • ( 3 . *X 28 - 1 

. )+F2*(5.»( Z2R+X2R-7 ,*X2R’Z2R)-1 . ) 

0033 



FN (5,2) • F1*(3.’Y2R-1 

. )+F2’(5. * (Z2R*V2R-7.’Y2R’Z2R)-1 . ) 

0034 



FN(6.3) • F1’(3.’Z2R-1 

. )’F2’(5.’(6.’Z2R -7,*Z2R’Z2R)-3. ) 

0035 



FN ( 4 . 2 ) « 3 . • F 1 ’XYR’5. 

•F2*XYP ■( 1 ,-7.’Z2R) 

0036 



FN (4,3) * 3.’F1»XZR’5. 

•F2’XZR’(3.-7.’Z2R) 

0037 



FN (5,3) • S.’FI’YZR’S. 

•F2’YZR’(3, — 7, ’Z2R) 

0038 



FN ( 5 . 1 ) ■ FN( 4 , 2 ) 


0039 



FN (6,1) « FN(4,3) 


0040 



FN (6,2 ) • FN( S , 3 ) 



0041 CALL MATA8(FN, PN , PON . 6 . 6, 6 ) 


C 


PONAV 
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C COMPUTE THE DIFFERENTIAL FOR CONTRIBUTION TO COVN DUE TO DYNAMIC NOISE 
C I.E COMPUTE QDOT > FN*0 * 0* FN ( TRANSPOSE ) + ON 
C • FN*Q ♦ ON ♦ (FN-O) TRANSPOSE 

C* ...... 


0042 

0043 

0044 


CALL MAI ABI FN, 0 .QDOT ,6,6,6) 
00 200 I « 1,6 

00 200 J • I .6 

* 

0045 

0046 

0047 


QOOT ( 1,01 * QOQT ( I ,.j) 
IF I I . EO.d 1 GO TO 205 
GO TO 210 

♦ OOOT(J.I) 

0048 

0049 

20 5 

ODOT ( 1 . J) * LOOT ‘ I ,d) 
GO TO 200 

♦ QN(I) 

0050 

210 

QDOT(J.I) * QOOT ( I ,J) 


0051 

200 

CONTINU . 


0052 


IF ( 10EBUG.GT. 3| «RITE(6.900> F 1 , F2 , ( ( FN( I , d ) , d> 1 , 6 ) , I 
. ( ( PDN( I.J).d»1.6).I>1.6).( ( QOOT ( I ,d) . J*1 ,8) , 1-1 .6 ) 

0053 

90 0 

FORMAT ( 4 X , ' IN PDNA V : ' , / , 

. 1 OX , ' FI « ' . E17. 10 . ' F2 • ' , 

, El 7 . 10, 


. /.10X.' FN: 1 . /.6( 10X.6( 1X.E17. 10),/), 
. 10X,‘ PON:‘,/,6(10X.6{1X.E17.10),/), 

. 1 OX, 1 OOOTt • . /.6( 10X.6( 1X.E17. 10)./) ) 

0054 RETURN 

0055 ENO 


Fag* 3 


PROGRAM SECTIONS 



Name 

Bytes 

At tr 

' i botes 

0 

SC ODE 

6e2 

PIC 

CON REL 

1 

SPDATA 

126 

PIC 

CON REL 

2 

SLOCAL 

176 

PIC 

CON REL 

3 

debug 

8 

PIC 

OVR REL 

4 

CONST 

112 

PIC 

OVR REL 

S 

RVF.C 

224 

PIC 

OVR REL 

6 

GFPART 

800 

PIC 

OVR REL 

7 

NS TATE 

112 

PIC 

OVR REL 

8 

ARRAYS 

1096 

PIC 

OVR REL 

9 

UPOT 

752 

PIC 

OVR REL 


ENTRY POINTS 
Address 
0^-00000000 

Type 

PONAV 




variables 

Address 

Type 

Name 

Address 

Type 

Name 

4-00000000 

R«8 

ATM 

4-00000060 

R*8 

OTU 

2-00000040 

1*4 

I 

3-00000004 

I *4 

I DEBUG 

4—00 0000 48 

R*8 

d2 

4 -Of 000050 

R*B 

03 


LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

LCL 

SHR 

NOEXE 

RD 

NONRT 

LONG 

LCL 

NOSHR 

NOEXE 

RD 

NRT 

QUAD 

GBL 

SHR 

NOEXE 

RD 

NRT 

LONG 

gbl 

SHR 

NOEXE 

RD 

VST 

LONG 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

GBL 

SHR 

NOEXE 

RD 

NRT 

LONG 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 


Address 

Type 

N&M# 

Address 

Type 

Name 

2-00000000 

R*B 

FI 

2-00000008 

R*8 

F2 

3-00000000 

1*4 

IENTER 

2-00000044 

1*4 

d 

4-00000058 

R»8 

J4 

4-00000068 

R*B 

PK1 


'U I - 


PONAV 
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5-00 000080 

R*8 

R2 

5-00000068 

R*a 

R3 

S-OOOOOOA8 

R*8 

RA 

7-00000060 

R«8 

R ADM 

4-00000010 

R • 8 

R8E 

4-00000008 

R • 8 

RBM 

4-00000020 

R*B 

RE2 

4-00000028 

R • 8 

RM2 

5-00 OOOOCO 

R*8 

RSMA 

4— 0 J 000030 

R*8 

UM 

4-00000038 

R • 0 

US 

2-00000010 

R* 8 

X2R 

2-00000020 

R*B 

XZR 

2-00000028 

R • 8 

V2R 

2-00000030 

r*s 

VZR 


ARRAYS 

Address 

1 VP* 

Na"*a 

By t es 

D i mens ion* 

6-00000080 

R*8 

EA 

384 

(4, 12) 

6-00000000 

R*B 

FA 

1 28 

(4 . 4) 

6-00 000200 

R*8 

FN 

288 

(6. 6) 

AP-00 000008# 

R*8 

PON 

288 

<6. 6) 

AP-00 000004* 

R*8 

PN 

288 

(6. 6) 

9-00000080 

R*8 

0 

2 88 

(6. 6) 

9-00000030 

R*8 

QA 

1 28 

(16) 

9-000001 DO 

R»8 

©DOT 

288 

(6. 6) 

9-00000000 

R«8 

QV 

48 

(6) 

5-00000000 

R • 8 

R 

24 

(3) 

5-00 0000 IB 

R*B 

RM 

24 

< 3 ) 

5-00000030 

R»8 

RO 

24 

(3) 

5 00000048 

R*8 

RSM 

24 

(3) 

5-00 000060 

R»8 

RSO 

24 

(3) 

5-00000078 

R«8 

RSS 

24 

(3) 

5-00 OOOOC8 

R*8 

RTG 

24 

(3) 

5-00000090 

R*8 

SB 

24 

(31 

8-00000000 

R*0 

T 1 

24 

(3) 

8-00 000098 

R*8 

Til 

72 

(3. 3) 

8-00000018 

R*8 

T2 

24 

(3) 

8-00 000030 

R*a 

T 3 

24 

(3) 

B-OOOOOOEO 

R*8 

T 33 

72 

(3. 3) 

8-00000048 

R*8 

T 4 

80 

(10) 

0-00 0001 28 

r*b 

T 44 

1 28 

(4. 4) 

8-000003E8 

R*8 

T5 

32 

(4) 

8-00000408 

R*8 

T 6 

32 

(4) 

8-000001 A6 

R*8 

T66 

288 

(6, 6) 

0-00000428 

R*8 

T7 

32 

(4) 

8-000002C8 

R*8 

T77 

288 

(6, 6) 

7-00000030 

R*8 

X 

48 

(6) 

7-00000000 

R*8 

XD 

48 

(6) 


LABELS 








Address 

Lao# 1 

Address 

Laeei 

Address 

Label 

Address 

Label 

0-00 COO 1F0 

200 

0-000001 EA 

205 

0-000001 F4 

210 

1-00000000 

900 ' 


7-00000068 

4-00000018 

4-00000040 

2-00000018 

2-00000038 


R*8 RAOE 
R»8 RBO 
R *8 UE 
R * 8 XVR 
R*8 22R 
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VAX-11 FORTRAN V2.0-2 
_DBAO: 101 1R.GCPJPONAV.FOR; 4 


FUNCTIONS ano subroutines referenced 

MAT AB 


TotBl Space Allocated * 4088 By tea 


COMMAND QUALIFIERS 

FORTRAN /LIST OCR. IN3A T A .MAT A8.QUTDATA . RUNG. ON AV , EPHEM, TRUE* • SPRESS , OCCULT , CP CRT .GCPSEQ. VISIBLE .GENENV , T REG, GV ROUT .RATE. BOAT , CMA 

/CME CK » ( NO BOUNDS . OVERF LON ) 

/DEBUG* I NO SYMBOL S « TRACEBACK ) 

/F77 /NOG FLOATING /14 /OPTIMISE /RARNINGS /NOO.LINES /NOMACHINE.COOE /CONT 1NUATI0NS-1* 


COMPILATION STATISTICS 

Run Tin*: 3.16 seconda 

Elapsed Tim*: 44.34 seconds 

Rags Faults: 387 

Dyne «iic Meaory: 180 pages 



2.6 Generate Measurement (MEASURE) 

MEASURE acts as an executive directing tbe program flow to tbe module 
appropriate for tbe simulation of tbe type of measurement to be made. The 
branch to tbe specific measurement simulation subroutine is based on an event 
code that may range from 1 through 15. Those significant to MEASURE are 1 
through 5. The mathematics relating to specific simulations will be spoken to 
under that routine name. The measurement simulation performed under specific 
event codes are listed b^low. 

Event Code Measurement Simulation Selected 

1 Landmark Tracker Measurement (GCP) with 

alternate actions 

2 Global Positioning System (GPS) Measurement 

3 Star Tracker Measurement with ST1 

4 Star Tracker Measurement with ST2 

5 No Measurements 

Alternate actions are made available under event code 1 if cloud cover is 
found to be in excess of 402. These actions are to make star tracker 
measurements with priority ST1, ST2 unless ST1 or both fixed trackers are 
occulted by a major body — earth, sun, or moon. 

Should tbe cloud cover be determined to be less than 402 but greater than 
102, tbe accuracy of tbe landmark measurement is degraded from an uncertainty 
of 3 meters la to 30 meters la . 

If tbe event code is one, indicating a GCP sighting, tbe cloud cover is 
determined by table hookup with linear interpolation driven by a random number 
from a random number generator. 

If tbe cloud coverage is greater than 402 tbe need for alternate action is 
tested by examining the norm of tbe body attitude quatern* an covariance. If 
this exceeds a specified bound an attitude update will be made using a star 
tracker if not occulted by a major body. 

After determination of cloud coverage, or if tbe original event code was 
not 1, tbe program branches to tbe appropriate subroutine responsible for 
generating tbe measurement. 

Figure A -29 •< '.aces the process of MEASURE. 






Ei'fcie 


on- 


SUBROUTINE MEASURE 




EVENT CODE .EQ. 1 


CALCULATE %CLOUD COVER 


ItK %CLOUDS .GT. 40 

T\ Q UNCERTAINTY .GT. QMAX /p 

TV %CLOUDS .GT. 10 /''f 

TV STAR VISIBLE TO ST 2 


SIGGCP = 30m SIGGCP = 3m 

EC=3 

STAR VISIBLE TO STl^ 

COMPUTE GCP OFFSET ANGLE 

EC=4 

EC=5 

TMEAS = TGCP (N) 

TMEAS-TIME + DTST 

SET NOPRINT 


READ TGCP (N + 1) 


12 


z 



Figure A-29 


,< w 1 up 
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00100 

0001 


SUBROUTINE MEASURE 

00200 


0 *• 


00300 


c 


oo-aoo 


c 

SUBROUTINE MEASURE acts as the executive for ALL SPACECRAFT 

00500 


c 

MEASUREMENTS MADE USING AN EXTERNAL STIMULUS. 

00600 


c 


OO’OO 


c 

INPUT VARIABL S 

00800 


c 

MCOOE = MEASUREMENT COOE - THOSE SIGNIFICANT TO 

00900 


c 

THIS MODULE ARE 1,2.3 AND 4 

01000 


c 

1 = LANDMARK TRACKER MEASUREMENT 

ul 100 


c 

2 = GPS MEASUREMENT 

01200 


c 

3 * STARTRACKER 1 MEASUREMENT 

01300 


c 

4 » STARTRACKER 2 MEASUREMENT 

01400 


c 


015CO 


c 

CUT PUT VARIABLES 

01600 


c 

THE OUTPUT VARIABLES ARE EXPLICIT IN THE 

01700 


r 

SUBROUTINES CALLED 

01800 


c 


01«0 


c 

PROGRAMMED BY JACK MYERS 13JUNE1980 

02000 


c 

EXT 4443 

02100 


c 


02200 


0 *< 



0002 


REAL'S QNORM ,PCNT . VECT1 .VECT2 

02400 


c 

COMMON BLOCKS 

02500 

0003 


INCLUDE ’TARG TS.COM’ 

02600 

0004 


COMMON /TARGETS/ MT Y PE , 1 S , NS , JF L AG .MCOOE , PI , T P I 

02600 

0005 


LOGICAL JFLAG 

02600 

0006 


REAL'S PI ,TP1 

02600 


• c 


02600 


• c 

MEASUR MENT SPECIFICATIONS 

02600 


• c 


02600 


* c 

MT V BE MEASUREMENT TYPE 

02600 


• c 

UFlAG SET FOR STAR OBSTRUCTION 

02600 


• c 

MCODE • * MEASUREMENT PROCESSING 

02600 


* c 

PI PI 

02600 


• c 

TP I 2* P I 

02600 


• c 


02600 

0007 


INCLUDE 'DEBUG.COM’ 

C0100 

oooa 


COMMON /DEBUG/ I f N T £R , 1 DEBUG 

00200 


* c 


00300 


* c 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

Ot 400 


* c 


00500 


• c 

I NTER IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 

00600 


• c 

I DEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

00700 


• c 


02700 

0009 


INCLUDE 'LMTPAR.COM' 

00100 

0010 


COMMON /LMTPAR/ A L . LON . L A T , T BN L < 3 . 3 ) . TNL ( 3 , 3 ) , BL ( 2 ) , S L ( 2 ) , 

00200 



BHL( 2) , SK L ( 2 ) ,TnLK(3,3) ,TIE0(3,3), S IGGCP , THET 

00300 

001 1 


REAL'P AL.TBNL.TNL . BL . S L . BK L , SKL , TNLK , T I EO , SIGGC P , LAT , LON, 

00400 



. TKET 

00500 


* c 


00600 


• c 


00700 


•» c 

LANDMARK TRACKER PARAMETERS 

OJ0CO 


• c 

AL ALTITUDE of LANDMARK (KM) 

00900 


• c 

LON = LONGITUOE OF LANDMARK (DEG) 

0<000 


• c 

LAT = LATITUDE OF LANDMARK (DEG) 

01100 


• c 

TBNL * OR.ENTATION ARRAY FOR LANDMARK TRACKER 
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01200 
01300 
01400 
0 ' 500 
01600 
01700 
01800 
01900 
02000 
OCIOO 
02200 
02300 
02400 
02500 
02800 
00100 
00200 
00300 
00400 
00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
0 1 600 
01700 
01800 
01900 
02000 
021 00 
02200 
02300 
02400 
02500 
02600 
02900 
00 100 
00200 
00300 
00400 
00500 
00500 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
03000 


0012 

0013 

0014 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


0015 

0016 

0017 


001a 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


tnl 

BL . 

SL 

BKL 

THET 

SKL 

TIEO 


TNLK 


SIGGCP 


NOMINAL TO BODY 

* MISALIGNMENT ARRAY " ACTU, L 

TRACKER TO NOMINAL 
» BIAS - ACTUAL (RAO) 

= NOISE STANDARD OEVIATtON - ACTUAL (RAD) 

= BIAS - KNOWLEDGE (RAO) 

= LOOK ANGLE ( RAO) 

= NOISE STANOARO DEVIATION -KNOWLEDGE (RAD) 
» INITIAL EARTH F1XE0 TO INERTIAL 
TRANSFORMATION 

* MISALIGNMENT ARRAY knowledge 

TRACKER TO NOMINAL 

* POSITION UNCERTAINTY DUE TO CLOUDS 


INCLUDE ’TIME.COM' 


COMMON /TIME/ T IME . T NEX T , T STOP , T I A , OE L , T IN . DIN . DA T EO . TZE RO 
COMMON /TIME/ |. M |; SiTRACKfT IS .TISN,DTA,DATER, TPRINT, DTPRINT 

REAL*B TI ME, TNEXT.TSTCP.TTA.OEL.TIN.DTN, DA TEO. TMEAS.TR AC K.TIS. 

. TISN.DT A .TZERO.OATER TPRINT ,0T PRINT 


THESE ARE THE TIME REFERENCE FRAMES 


T IME 

TNEXT 

TSTOP 

TIA 

0 L 

TIN 

D T N 

DATEO 

DATER 

T ZERO 

TSLEW 

TIS 

TISN 

OTA 

TPRINT 

DTPRINT 


ATOMIC TIME SINCE INITIALIZATION (SEC) 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

RUN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

- « STEP SIZE (SEC) 

POSITION INTEGRATION TIME (SEC) 

- • STEP SIZE (SEC) 

DATE OF FLIGHT EPOCH (UD) 

DATE OF 1950 EPOCH (UD) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

REAL WORLD REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY + OEL BUT ♦ TSLEW - TIA WHEN DEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


INCLUDE 'PHiA.COM' 

COMMON /PHIA/ PA(4,4 ) , TA(4 , 1 2) , P0A(4, 
. COVA( 16. 1 6 ) . POA( 1 6, 16) , QMAX 

REAL'S PA.TA.POA.PHI A.COVA.POA.OMAX 


16), PHIA (16,16) 


THESE ARE THE ATTITUDE TRANSITION AND COVARIANCE MATRICES 

PA ATTITUDE STATE TRANSITION MATRIX 

T A • PARAMETER TRANSITION MATRIX 

p CA • DERIVATIVE OF TRANSITION MATRICES 

PHIA * AGGREGATE TRANSITION MATRIX 

C0 VA * NEW COVARIANCE MATRIX 

PQA * PREVIOUS COVARIANCE MATRIX 

QMAX " COVARIANCE NORM MAX 


INCLUOC 'MODE. COM 


Page 2 
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1 0- Apr-1 981 


09:13:05 
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1 


00100 

00200 

00300 

00400 

00500 

00600 

00700 

00800 

00900 


0019 


• c 

• c 

• c 

• c 

• c 

• c 

• c 
« c 


01000 

v 

C 

01100 

• 

C 

01200 

• 

C 

01300 

* 

C 

01400 

« 

C 

01500 

• 

C 

03100 

0020 


0320C 

0021 


r 3300 


c» **• 

03400 


C 

03500 


c* ••• 

03600 

0022 


03700 

0023 


03800 

0024 


03900 

0025 


04000 

0026 


04 100 


c* Ml 

04200 


c 

04300 


C* «*i 

04400 

0027 


04500 

0028 


04600 


c* **< 

04700 


c 

04800 


c 

04900 


C* **' 

05000 

0029 

100 

05100 

0030 


05200 

0031 

105 

05300 

0032 


05400 

0033 


05500 

0034 


05600 


c« •• 

05700 


c 

05800 


c 

05900 


c* •* 

06000 

0035 


06 ICO 

0P3B 


06200 

0037 


06300 


c* ** 

06400 


c 

06500 


c 

06600 


c* ** 

06700 

0038 


06800 

0039 


06900 

0040 


07000 

0041 

50 0 

07100 

0042 


07200 

0043 

20 0 


COMMON /MODE/ MOOE(IO) 


MODE ( 1 ) 
MODE < 2) 


LANDMARK tracker sweep mode 

0 • RANDOM 

1 = FIXED Ar INPUT THET 

2 = NO DEFAULT TO STAR TRACKER 

CLOUD SELECTION MODE 

0 * RANOOM C LOUD DENSITIES BASED 

ON INPUT TABLES CLOTBL 

1 * FIXED DENSITY AT NO CLOUDS 

2 * NO CLOUDS WITH 1 00% CLOUD 

COVER FOR A SPECIFIED 
PERIOD (CL0TBH1 1 .12)) 


MODE (3-10) NOT SPECIFIED AT PRESENT 


DATA I 1.12/54321. 123-15/ 

I F ( MCODE .NE. 1) GO TO 1000 ,,»**««»****•***** 

CALCULATE PERCENT CLOUD COVER 

CALL R ANDU ( I 1 . 12. X) 

CALL C LOTBL ( X.PCNT ) 

IF(PCNT .GT. 40.) GO TO 100 
SIGGCP'3. 

I F ( PCN T .GT. 10.) S I GGCP *30 . ,«***»****•* 

COMPUTE OFFSET ANGLE ,,*.**,♦*♦«**•• 

CALL RDGCP 

GO TO 1000 «.,.»****»***** 

'cOMPUTE*NORM OF ATTITUDE QUATERNIAN COVARIANCE 
(AN APPROXIMATION TO VARIANCE) 

QNORM* 0 . 

i)0 105 1*1.4 

QNORM= QNORM+COVA ( I . I ) 

CNORM=SORT(QNORM) 

IFIQNORM .LE. 9MAX) GO TO 500 
I F ( MODE ( 1 ) -EQ. 2) GO TO 500^ 

CHECK TO SEE IF KNOWLEDGE OF STAR LOCATION IS VISIBLE 
TO ST 1 *«*«.**•**»****•***•' 

CALL B VECT ( V ECT 1 . 1 ) 

CALL V I S I BLE ( VECT 1 ,5,L) 

.FI. NOT. L) GO TO 300 ^ .,.«*.*..****...«* 

* CHECK TO SEE IF KNOWLEDGE OF STAR LOCATION IS VISIBLE 

T0 ST2 * ***.*•»•*•*••**••*••«•• 

CALL B VECT ( V ECT2 . 2 ) 

CALL VISIBLE(VECT2.5,L) 

IF( .NOT . L) GO TO 200 
MCODE* 5 

GO TO 1000 

MCODE* 4 


\ 


Page 
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07300 

0044 

07400 

0045 

07500 

0046 

07600 


07700 


07800 


07900 

0047 

08000 

0048 

08100 


08200 


06300 


06400 

0049 

08500 

0050 

08600 


08700 


08600 


08900 

0051 

09000 

0052 

09100 


09200 


09300 


09400 

0053 

09500 

0054 

09600 


09700 


09800 


09900 

0055 

10000 

0050 

10100 

0057 


GO TO 1000 
30 0 MCODE* 3 

1000 continue 

c BRANCH TO THE APPROPRIATE SUBROUTINE ON MCODE 

£•••••••* 

GO TO < 10,20 ,30.40 ) .MCOOE 
RETURN 

C MAKE IANOMARK TRACKER MEASUREMENTS 

10 CALL LAMKT 

RETURN 

C MAKE GPS MEASUREMENTS 

C* ••*•••••••** ******* 

20 CALL GPS 

RETURN 

C** MAKE MEASUREM NTS WITH STARTRACKER 1 

c. ••••**•••« •** 

30 CALL START! 1 ) 

RETURN ,,,•««.*« 

c MAKE MEASUREMENTS WITH STARTRACKER 2 

C** ».......•..*•••••••••*•*•*••••••••*•*••*• •*••••* 

40 CALL START (2 ) 

RETURN 

END 
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PROGRAM sections 


Name 


0 scop: 

1 S P DA T A 

2 SLOCAL 

3 TARGETS 

4 DEBUG 

5 IM T PAR 

6 TIME 

7 PHI A 

8 MODE 


Bytes Atti 

248 PIC 
12 PIC 
152 PIC 
36 PIC 
8 PIC 
392 PIC 
136 PIC 
7176 PIC 
40 PIC 


i butes 

CON REL LCL 
CON REL LCL 
CON REL LCL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 
□VR REL GBL 
OVR REL GBL 
OVR REL GBL 


ShR EXE 
SHR NOEXE 
NOSHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 


RO NOWRT LONG 
RD NOWRT LONG 
RD WRT QUAD 
RD WRT LONG 
RD WRT LONG 
RO WRT LONG 
RD WRT LONG 
RD WRT LONG 
RD WRT LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 MEASURE 


VARIABLES 



Address 

Type 

Name 

Address 

T ype 

Name 


5-00000000 

R *8 

AL 

6-00000038 

R *8 

OATE0 

> 

6-00000068 

R *8 

OTA 

6-00000030 

R *8 

OTN 

L. 

2-00000020 

1*4 

I 1 

2-00000024 

I *4 

12 

00 

3-00 000004 

1*4 

IS 

3-00C0000C 

L *4 

OF LAG 

X." 

5-00 000008 

R *8 

LON 

3-00000010 

1*4 

MCOOE 


2-00000008 

R *8 

PCNT 

3-00000014 

R • 8 

PI 


5-00000178 

R *8 

SIGGCP 

5-00000 1 80 

R *8 

THET 


6-00O00028 

R *8 

TIN 

6-00000058 

R * 8 

T I S 


6-00000008 

R »8 

TNEXT 

3-0000001C 

R *8 

TP I 


6-00000010 

R *8 

tstop 

6-00000040 

R *8 

TZERO 


2-00000028 

R*4 

X 





Address 

Type 

Name 

Address 

Type 

Name 

6-00000070 

R »8 

DATER 

6-00000020 

R » 8 

DEL 

6-00000080 

R* 8 

DTPRINT 

2-0000002C 

1*4 

I 

4-00000004 

1*4 

I DEBUG 

4-00000000 

1*4 

I ENTER 

2-00000030 

1*4 

L 

5-00000010 

R *8 

LAT 

3-00000000 

1*4 

MT YPE 

3-00000008 

1*4 

N5 

7-00 00 1 COO 

R *8 

QMAX 

2-00000000 

R * 8 

ONORM 

6-00000018 

R *8 

TIA 

6-00000000 

R *8 

TIME 

6-00000360 

R *8 

TISN 

6-00000048 

R *8 

TMEAS 

6-00000078 

R *8 

TPRINT 

6-00000050 

R *8 

TRACK 

2-00000010 

R *8 

VECT1 

2-00000018 

R *8 

VECT2 


ARRAYS 


Address Type 


5-00 0000C8 
5-00 0000 A 8 

7- 00 OOOCOO 

8 - 00000000 
7-00 COOOOO 
7- DO 000200 
7-00000400 
7-00001400 
5—00 0000 D 8 
5-00 000088 
7-00000080 
5-00000016 
5-00000130 
5-00000060 


Name 

R *8 BKL 
R *8 BL 
R *8 COVA 
1*4 MODE 
R *8 PA 
R *8 PDA 
R *8 PHIA 
R *8 POA 
R *8 SKL 
R *8 SL 
R *8 TA 
R *8 TBNL 
R*8 TIEO 
R *8 TNL 


Bytes 

D i mens i on* 

16 

( 2 ) 


16 

( 2 ) 


2048 

( 16 . 

16) 

40 

( 10 ) 


1 28 

(4, 

4) 

512 

(4. 

16) 

2048 

(16, 

16) 

2048 

(16, 

16) 

16 

( 2 ) 


16 

( 2 ) 


384 

(4, 

12 ) 

72 

(3, 

3) 

72 

(3, 

3) 

72 

(3, 

3) 
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S-000100EB R*B TNLK 


72 (3, 3) 


LABELS 

Address Labe 1 

0-00000004 10 

0-00 0000B3 200 


Address 

Labe 1 

Address 

Label 

Address 

Labe 1 

Address 

Labe 1 

Address 

Label 

0-0000 OODC 
0-000000BC 

20 

300 

0-000000E4 

0-000000AA 

30 

500 

O-OOOOOOEE 

0-000000C3 

40 

1000 

0-00000048 

100 


105 


FUNCTIONS and subroutines referenced 

bvect clotbl forsranou GPS 

VISIBLE 


LAMKT 


MThSDSQRT rdgcp start 


Total Space Allocated • 8200 Bytea 


command qualifiers 


fortran /l measure 


> 

I 


/CHECH* ( NO BOUNDS .OVERFLOW) 

/F77^/NOG^FLOAT ^NG^/ 14^/OPT IMI Z E /WARNINGS /NOO.LIHES /NOMACHINE .CODE /CONT INUAT IONS- 1 9 


COMPILATION STATISTICS 


Run Time: 
Elapsed Time: 
Page Fau'ts: 
Dynamic Memory: 


1 . 99 seconds 
20.71 seconds 
171 

47 pages 


2.6.1 GPS Model (GPS) 

Subroutine GPS .tauLte. . Glob.l Po.itionin, S,.t» -..ur.«nt by 

corrupting tbe true uebicle po.ition-rnlocit, rector .itb bt.. nnd r.nOo. 

nni«« P Compensation is then made for any biases known to be in the 

noise. Compensation / subroutine, tbe measurement noise 

i. In “nnt'rnifts and varlablea are co™unic.ted through 

common. 

Simulation Equations 
Measurements 

MP « P + PB + N(0 ,PS) *» PBK 
MV = V + VB + N(0,VS) - VBK 

where N(y,a) = normal random variable with mean, y, and 
standard deviation, o. 


Covariance 


[rgps] 


PSKOV 


PSK(2) ‘ 


o 


PSKOV 


o 


VSK(lV 


VSK(2)‘ 


VSK(3V 


A-186 



Figure A- 30 
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00100 

OO^oo 

0001 



SUBROUTINE GPS 

00300 



c 


00400 



c 

SUBROUTINE GPS SIMULATES A MEASUREMENT MADE BV AN ONBOARD 

^0500 



c 

GPS RECEIVER BY SIMPLY ADDING BIAS AND NOISE TO THE 

ocsoo 



c 

ACTUAL VEHICL. POSITION ANO VELOCITY STATE VECTOR. 

00700 



c 

ONCE THE MEASUREMENT IS MADE . COMPENSATION FOR TN HE 

00800 



c 

BIAS TO THE EXTENT OF BIAS KNOWLEDGE IS SUBTRACTED 

00900 



c 

FROM THE MEASUREMENT POSITION AND VELOCITY VECTOR. 

01000 



c 


01 100 



c 

INPUT PARAMET RS 

01200 



c 

P * ACTUAL POSITION VECTOR (KM) 

01300 



c 

V » " VELOCITY ■ (KM/S) 

01400 



c 

PB » ' POSITION BIAS VECTOR (KM) 

01500 



c 

VB » ‘ VELOCITY ■ • (KM/S) 

0»600 



c 

PS r ■ POSITION NOISE STANDARD DEVIATION 

0I7C0 



c 

(KM) 

01800 



c 

VS * ’ VELOCITY * ■ • 

01900 



c 

(KM/S) 

02000 



c 

PBK > POSITION BIAS KNOWLEDGE (KM) 

02100 



c 

V6K * VELOCITY " • (KM/S) 

02200 



c 

PSK * POSITION STANDARD DEVIATION KNOWLEDGE 

02300 



c 

(KM) 

02400 



c 

VSK « VELOCITY " • 

02500 



c 

(KM/S) 

02600 



c 


02700 



r 

OUTPUT PARAMETERS 

02800 



c 

MP » MEASUREMENT POSITION VECTOR (KM) 

02900 



c 

MV • * VELOCITY " (KM/S) 

03000 



c 

RGPS» COVARIANCE OF GPS MEASUREMENT NOISE 

03100 



c 

( KM) » • 2 ■ (KM/S ) »»2 

032C0 



c 


03300 



c 

PROGRAMMED BY JACK MYERS EXTENSION 4443 

03^00 



c 

4JUNE1 980 

03300 



c 


03600 



c 


03700 



c* *< 


03800 



w 

COMMON BLOCKS 

03900 

0002 



INCLUDE ' ENV ) R . COM ' 

04000 

0003 

• 


COMMON /ENVIR/ STATE( 10) ,PR0FILE(10,4) ,INIT 

04000 

0004 

• 


real*b state. PROFILE 

04000 


• 

c 


04000 


• 

c 

REAL WORLD STATE PARAMETERS 

04000 


• 

c 


04000 


• 

c 

STATE STATE VALUES; X . Y . Z , XD . YD , ZD . EO . E 1 . E2 

04000 


• 

c 

PROFILE AT T 11 UDE PROFILE-TIME (SEC) VS 

04000 


• 

c 

INERTIAL ANGULAR RATES (RAD/SEC) 

04000 


• 

c 

INIT INTEGRATION INITIALIZATION KEY (-1) 

04000 


• 

c 


0400 J 

0005 



INCLUOE 'DEBUG.COM' 

00100 

0006 

• 


COMMON /DEBUG/ I ENT ER . 1 DEBUG 

00200 


• 

c 


00300 


• 

c 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

00400 


• 

c 


00500 


• 

c 

INTER IF 1, PRINTS WHEN ENTERS MOST SUBROUT 

QQSOO 


• 

c 

IDEBUG 0-10. HIGHER NUMBER MEANS MORE PRINT 

00700 


• 

c 
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04100 

04200 

04200 

04200 

04200 

04200 

04200 

04200 

04200 

04200 

04200 

042CO 

04200 

04200 

04200 

04200 

04200 

04200 

00100 

00200 

00300 

00400 

00500 

00600 

00700 

00600 


oo 


0007 

oooa 

0009 


ooto 

001 1 


0012 


COMMON /GPSPAR/ PB ( 3 ) . VB ( 3) . PS ( 3 ) . VS ( 3 ) . PBK < 3 } . V BK ( 3) . PSK( 3 ) , 
VSK ( 31 

REAL*8 PB.VB.PS.VS.PBK. VBK.PSK .VSK 


GPS PARAMETERS 
PB 
VB 
PS 
VS 
PBK 
VBK 
PSK 

VSK 


« POSITION BIAS - ACTUAL 

* VELOSITY BIAS - ACTUAL 

, POSITION NOISE STANDARD DEVIATION 
» VELOCITY NOISE STANOARD DEVIATION 
» POSITION BIAS - KNOWLEDGE 
, VELOCITY BIAS - KNOWLEDGE 

• POSITION NOISE STANOARD DEVIATION 

KNOWLEDGE 

« VELOSITY NOISE STANDARD DEVIATION 
KNOWLEDGE 


ACTUAL 

ACTUAL 


COMMON /MEASOUT/ MX ( 6 ) . RGPS( 6 . 6 ) , DHCS ( 2 ) . DVCS( 2 ) , MS( 3 . 2 ) . 
RSI 2 ,2.21 .DHCL.9VCL. LMU(3) .RH2.2) ,EMXG( 6). 

EDMS (2 ) . EOVSI 2) . EOHL. EOVL 

REAL*B MX , RGPS .DHCS .DVCS .MS, RS ,DMCL , DVCL , LMU ,RL , EMXG, 
EDHS.-OVS.EDHL.EDVL 


00900 

01000 

• c 

• c 

MX 

EMLG 

01100 

• c 

01200 

. c 


01300 

• c 

RGPS 

01400 

• c 


01500 

• c 

DHCS 

01600 

• c 


Cl 700 

• c 

DVCS 

01800 

• c 


01900 

• c 

EDHS 

02000 

■» c 


02100 

• c 

EDVS 

02200 

• c 

MS 

02300 

• c 

02400 

• c 

RS 

02500 

• c 

02600 

• c 


02700 

• c 

DHCL 

02BOO 

• c 


02900 

• c 

DVCL 

03000 

• c 


03100 

• c 

EOHL 

03200 

• c 


03300 

• c 

EDVL 

03400 

• c 

LMU 

03500 

• c 

03600 

• c 

RL 

03700 

• c 


03800 

• c 


04300 

c 



GPS 


MEASUREMENT OUTPUT PARAMETERS M r *c,. D EMFNT 

• PQ5 1 T 1 ON/VE LOCI TV STATE MEASUREMENT 
( KM. KM/SCC) 

. ESTIMATED posit ion/ veloc i ty state 

MEASUREMENT - HOPS 

. STATE MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - GPS < KM* »2 , KM/SEC»»2 ) 

■ STAR MEASUREMENT HORIZONTAL PEVIAIION 
FROM BORESIGHT - START (RAD) 

* star measurement vertical deviation 

FROM BORESIGHT - START (RAD) 

» ESTIMATED STAR MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RAO) 

« ESTIMATED STAR MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAO) 

• STAR MEASUREMENT UNIT VECTOR (SECOND 
SUBSCRIPT REFERS TO TRACKER) - START 

. STAR MEASUREMENT NOISE COVARIANCE 
(KNOWLEDGE) - START <RAD**2) 

. LANDMARK MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - L*MKT (RAD) 

» landmark measurement vertical OEVIATION 

FROM BORESIGHT - L*M«T (RAO) 

. ESTIMATEO LANDMARK MEASUREMENT HORIZONTAL 
DEVIATION FROM BOKESIGHT (RAD) 

* ESTIMATEO LANDMARK MEASUREMENT VERTICAL 
OEVIATION FROM BORES IGHT (RAO) 

. LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 
. LANDMARK MEASUREMENT NOISE COVARIANCE 
(KNOWLEDGE) " LAMKT (RAD*»2) 
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Pm 


> 

■ 

■£ 


GPS 

94400 


C 

04500 

0013 


04600 


C 

04700 


C 

04B00 

0014 


04900 


C 

05000 

0015 


05100 

00 <6 


05209 


c* « 

05 3C0 


c 

05400 


c 

05500 


c* > 

05600 

001’ 


05700 

0018 


C5800 

0019 

1 5 

05900 

0020 


06000 


c* 

06100 


c 

06300 


c* 

06301 

00L t 


06400 

0032 


065C0 

0023 


06600 

0024 

IS 

06'. JO 

0035 


06800 

0026 


06900 

0027 

29 

07000 

0028 


07100 

C029 



6- Apr- 1981 
30-Sep-1 980 


14^56:00 

07:33:03 


EQUIVALENCE (MX.MPi .<•**( 4J.A1V) , ( P, ST ATE ) , ( V , ST AT E ( 4) ) 
DIMENS ION 

DIMENSION MP ( 3) ,MV( 3) .P( 3) .VI 3 ) 

REAL'S MP, MV ,V.P. GAUSS 
DATA 1 FLAG /O/ 

ADO BIAS ANO NOISE TO THE POS 1 T ION/ VELOC I TV VECTOR 
THEN SUBTRACT BIAS KNOWLEDGE 

DO 10 l«!,3 , . . 

MP( 1 ) * P( I ) V PB( I 1 'GAUSS ( 0 . , PS( I ) )-PBN( I ) 

MV< I )■* V< U*Vai II 'GAuSS ( 0 . ,VS( 1 ) )-VBK< I ) 

IF ( I F LAG .EO 1) RETURN 

SET UP NOiSE COVARIANCE - FIRST PASS ONLY 

M • ** * * •••••••»••••••*••• ••••••••••••••• * 

iflag* 1 
DO 15 1 « 1 , 6 
DC 15 J«1.6 
RGPM I .J)-0. 

OO 20 1*1.3 

RGPSll ,I)»PSR(n*PSK(I) 

RGPSI 143.1+3) «VSX( 1 ) »VSK( l ? 

RETURN 

END 


% .¥ 



G°S 6-Apr-lgBt 1 4 : 56: CO VAX-11 FORTRAN V2.0-2 Fag* 4 

30-S#p-1980 0*:33:03 _DBAO: [01 1R.GCP1GPS. FOR:8 

progr ■ a sect IONS 



Name 

Bytes 

Attribute* 







0 

SC OOF. 

310 

PIC CON REL 

LCL 

SMR 

EXE 

RD 

NOMRT 

LONG 

1 

S®OAT A 

4 

PIC CON REL 

LCL 

SHR 

NOEXE 

RD 

NOMRT 

LONG 

3 

SLOCAL 

34 

PIC CON REL 

LCL 

NOSMR 

NOEXE 

RD 

NRT 

LONG 

3 

CNVIR 

404 

PIC GVR REL 

CBL 

SHR 

NOEXE 

RD 

NRT 

‘ONG 

4 

DEBUG 

B 

PIC OVR REL 

GBL 

SMR 

NOEXE 

RD 

NRT 

LONG 

5 

CPSPAR 

192 

PIC OVR REL 

CBL 

SHR 

NOEXE 

RD 

NRT 

LONG 

«a 

ME ASOUT 

648 

PIC OVR REL 

CBL 

SHR 

NOEXE 

RD 

NRT 

LONG 


entry points 

Address Typ* Nam* 
0-00030000 OPS 


VARIABLES 


Address 

Typ* 

Ne.it* 

Address 

Typ* 

Nam* 

Address 

Type 

Nam* 

Address 

Typ* 

Nam* 

> 6-00 000 1 EO 

R*8 

OHCL 

6-00000 1E8 

R*8 

DVCL 

6-00000278 

R*e 

EDML 

6-00000280 

R*8 

EDVL 

— 2-00 00000 A 

1*4 

I 

4-00000004 

1*4 

I DEBUG 

4-00000000 

1*4 

IENTER 

2-00000000 

1*4 

I FLAG 

c 3-00000190 

1*4 

INI T 

2-OOOOOOOb 

1*4 









ARRAYS 



Address 

Typ* 

Nam* 

Bytes 

Di mens Ions 

6-000001SO 

R*8 

DHCS 

16 

(2) 

6-00000160 

r*b 

oves 

16 

(2) 

6-00000268 

R*8 

EOH'i 

16 

(2) 

6-00000268 

fl»8 

EDVS 

16 

( 2 1 

6-00 0CO228 

R*8 

EMXG 

48 

(6) 

6-000001 FO 

R*d 

LMU 

24 

(3 ) 

6-00 000000 

R»B 

MP 

24 

(3 ) 

6-00 0001 70 

Rv8 

MS 

48 

! 3 • 2) 

6-00000018 

R • B 

MV 

; t 

(3) 

6-00000000 

R»8 

MX 


(6) 

3-00000000 

R*S 

P 


(3 ) 

5- 00000000 

R*8 

PB 

24 

(3? 

5-00000060 

R»8 

PBK 

24 

(3) 

>-00000050 

R*8 

PROFILE 

i ?o 

(10, 4) 

5-00000030 

R*S 

PS 

24 

(3) 

5-00 UC0090 

R*8 

PSK 

24 

(3) 

6-00000030 

R*B 

RGPS 

268 

(6, 6) 

6-00 000208 

R*8 

RL 

32 

(2. 2) 

6-00 0001 AO 

R«8 

RS 

64 

(2. 2, 2) 

3-04000000 

R*8 

STATE 

80 

(10) 

3-00000018 

R 5 


24 

(3) 

5-000000 IB 

R*8 

VB 

24 

(3) 

5-00000078 

R*8 

VBK 

24 

(3) 

5-00000046 

R*8 

VS 

24 

(3) 


I, 



Zb\-' 


GPS 


6-Apn-1 981 14:56:00 
30-Sep-l 980 07:33:03 


VAX-11 FORTRAN V2.0-2 
OSAO: t011R.GCP]GPS.F0R;8 


Page 


5 


5-000000AB 

R*8 VSK 


24 

(3) 


LABELS 

Address 

*• 

Label 

10 

Address 
* * 

Label 

15 

Address 
• • 

Label 

20 


functions ano subroutines referenced 

GAUSS 

Total Space Allocated « 1490 Bytea 


COMMAND QUALIFIERS 

fortran /list GCP.INOATA.MATAB.OUTOATA.RUNG.DNAV.EPHEM.TRUEA 

> /CHECK* (NO BOUNDS .OVERFLOW) 

/.«««■«. 


.SPRESS.OC CULT. GPERT.GCPSEQ. VISIBLE. GENENV 

/NOMACHINE.CODE /C0NTINUATI0NS-19 


treg.gyrout.rate.bmat ,cma 


COMPILATION STATISTICS 


Run Time: 
Elapsed Time: 
Page Faults: 
Dynamic Memory: 


1 . 42 seconds 
2T.19 seconds 
358 

160 pages 


0 

1 

vr 










2.6.2 Star Tracker Model (START) 



Subroutine START siaulatea a star tracker measurement made by the Rtb 
tracker, where K is passed through the subroutine calling sequence. For 
purposes of simulation die star of interest is aqsumed to be along the Ktb 
tracker bores igbt. A unit vector along the Ktb tracker bores ight is 
established and corrupted with bias and noise. Compensation for known bias is 
made by subtracting this knowledge from the unit vector. After the corrupted 
vector is unitised, the data is passed out through conaon. The measurement 
noise covariance is reestablished on each pass. This information is also 
passed out through common. 

GAUSS is required to generate normally distributed random measurement noise. 
Mathematical Specification - 


Establish a unit vector along the tracker boresigbt. 


U = 


Establish star measurement vector by adding bias and noise to the unit 
vector, and compensating for bias knowledge. 


MS(K) = U + BS(K) + N(0,SS(K)} ^ BSK(K) 

N(u,o) “ Normal variable with mean, y , and standard deviation, a . 
Reconstruct a unit vector 


Establish sensor measurement 

DVCS = AS1N(MS(1,K) 

DHCS = AS IN (MS ( 2, K) /COS (DVCS (K))) 

Establish measurement covariance 

SSK(1 ,K) 2 0 

0 SSK(2 ,K) 2 
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STAR TRACKER MODEL (START) 




GENERATE MEASUREMENT UNIT 
VECTOR 


CORRUPT MEASUREMENT WITH 
BIAS AND NOISE 



COMPENSATE FOR BIAS KNOWLEDGE 


NORMALIZE MEASUREMENT VECTOR 


FIRST PASS 


GENERATE MEASUREMENT 
NOISE COVARIANCE 


NULL 


Figure A-31 



6-AD1--1 981 l4:5C"-22 
9-fef?-198i 1 8 • 2 2 0 5 


VAX-11 FORTRAN .2.0-2 
..OBAO: [ D 1 -R.GCR START .FOR 


00100 0001 
OC200 C* • 

00300 C 

00400 c 

0C500 C 

00600 C 

o:7oo c 

oceoo c 

00900 C 

01000 c 

O’lOO c 

01200 C 

01300 C 

01400 C 

01500 C 

01600 C 

01700 C 

01800 c 

01900 C 

02000 C 

02'00 C 

02200 C 

02300 C 

02400 C 

02500 C 

> 02600 C 

* 02700 0 

~i 02800 C 

02900 C 

03000 C 

02100 C 

03200 C 

03300 C 

03400 C 

03500 C 

03600 C 

03700 C 

03800 0 

03900 C 

04000 C» 

04100 C 

04200 0002 

00 100 0003 • 

00200 • C 

00300 • C 

00400 • c 

00500 • C 

00600 • C 

00700 • C 

04300 0004 

04400 0005 • 

04400 • 

04400 0008 • 

04400 • C 

04400 • C 

04400 • C 

04400 • C 


SuBROU 1 INE S T i i 


SuS»OjMNE START SI- 
GNBOARD FIXED S» 
TQ A UNIT VECTOR tl' 
ONCE THE measuseve-. 
BIAS IS MADE 67 So a 
MEASUREMENT 


VU.ATES A MEASUREMENT MADE BY an 
•BACKER BY ADDING BIAS AND NOISE 
C-.G THE STAR TRACKER BORESIGHT. 

T ;s MADE COMPENSATION FOR THE KNOWN 
TRACT IMG THAT BIAS FROM THE 


INPUT 


paramet 

RS 

INERTIAL TO BODY OUATE^NIANS I 4 *’) 

o 

* 

V 

BS 

* 

JTAR TRACKER ACTUAL BIAS VECTOR (2*1) 
(RAO) 

ss 

* 

. . • notse standard 

( RAD) 

DEVI AT ION (2*1 ) 

TNS 

= 

- • MISALIGNMENT ARRAY (3-3) 

.STAR TRACKER TO NOMINAL) 

TBNS 

m 

■ • ORIENTATION ARRAY ( 3*3 ) 

(NOMINAL TO BODY) 

BSK 

X 

■ * BIAS KNOWLEDGE (3*3) 

(RAD) 

SSK 

3 

NOISE STANDARD DEVIATION 
KNOWLEDGE (2*1) (RAD) 

TNSK 

3 

• • misalignment knowledge 

( 3*3 ) f STAR TRACKER TO NOMINAL) 


OUTPUT VARIABLES 
DHCS 
OVCS 

MS 

RS 


hC° I ZONT A- DEVIATION FROM BORESIGHT (RAD) 
VERTICAL DEVIATION FROM BORESIGHT (RAO) 
MEASUREMENT STAR VECTOR (3*1) 

STAR NOISE COVARIANCE (2*2) CHECK 
(RAD) *»2 


PROGRAMMED by jack MYERS 11UUNE1980 
EXT 4443 


COMAON SLOCKS 
INCLUOE -DEBUG. COM’ 

COMMON /DEBUG/ I EN r E R . » OE BUG 

USER CONTROL. ED PARAMETERS TO VARY OEBUG PRINT LEVEL 

I NTER IF 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
IDE0C1 0-10. HIGHER NUMBER MEANS MORE PRINT 


COMMON^ /STAR PAR/ C 2,2) , SS( 2 , 2 ) ,TNS( 3.3.2) .TBNS (3,3.2) 
BSK( 2. 2) . SSK (2 .2 ) . TNSK (3,3.2 ) 

REAL* 8 BS.SS.TNS.TB-.S.BSK. SSK , TNSK 

ST« t<St REFERS TO T« 

tracker used 



START 




04400 



C 

04400 



C 

04400 



C 

04400 



c 

04400 



c 

04400 



c 

04400 



c 

04400 



c 

04400 



c 

04400 



c 

04400 

04400 

0007 


c 

00100 

00200 

00300 

0008 



00400 

00500 

0009 



00600 



c 

00700 



c 

00800 



c 

00900 



c 

01000 



c 

Ot 100 



c 

01200 



c 

01300 



c 

01400 



c 

01500 



c 

01600 



c 

01700 



c 

0 1 BOO 



c 

01900 



c 

02000 



c 

02 ’ 00 



c 

32200 



c 

02300 



c 

C2400 



c 

02500 



c 

02600 



c 

02700 



c 

02000 



c 

02900 



c 

03000 



c 

03100 



c 

03200 



c 

03300 



c 

03400 



c 

03500 



c 

03600 



c 

03700 



c 

03800 

04500 

04600 

04700 

04800 

04900 

05000 

05100 

0010 
001 1 
0012 


c 

c 

c» 

c 

c» 


6 -Apr- 1 98 1 14:56:22 VAX-11 FORTRAN V2.0-2 
9-Feb-198l 18:22:05 _DBA0: (DU R . GCP 1ST ART . FOR : 1 2 

BS = BIAS - ACTUAL (RAO) 

SS * *.O.SE STANDARD DEVIATION - ACTUAL (RAD) 

TNS * MISALIGNMENT ARRAY - TRANSFORMATION FROM 

STAR TRACKER TO NOMINAL 

TBNS = ORIENTATION ARRAY - TRANSFORMATION FROM 
NOMINAL TO BODY 

6SK = BIAS - KNOWLEDGE (RAO) 

SSK = NOISE STANDARD DEVIATION -KNOWLEDGE (RAD) 

TNSK = MISALIGNMENT KNOWLEDGE ARRAY - TRANSFORMATION 
F POM STAR TRACKER TO NOMINAL 

INCLUDE ' ME A SOU T. COM ' 

COMMON /MEASOUT/ MX < 6 ) . RGPS( 6 . 6 ) . OMCS ( 2 ) , DVCS( 2 ) . MS{ 3 . 2 ) . 

RSI 2 .2,2 i , Dmcl ,DVCL, L V . J ( 3) . RL(2,2) , EMXG( 6) , 

EOHS ( 2) .EDVSI2) . EOHL, EEVL 

REAL'S MX .RGPS.DMCS.DVCS ,MS, RS .DHCL. DVCL , LMU.RL, EMXG. 

EDMS. DVS.EOHL.EDVL 


MEASUREMENT OUTPUT PARAMETERS 

MX • POSITION/VcLOCITY STATE MEASUREMENT - GPS 

(KM. S1V /SEC) 

EMXG * ESTIMATED POSITION/VELOCITY 5* ATE 
MEASUREMENT - HGPS 

RGP3 * STATE MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - GPS ( KM« » 2 . KM/SEC*»2 ) 
OHCS * STAR MEASUREMENT HORIZONTAL DEVIATION 



from EORESIGHT - START (RAD) 

OVCS * STAR MEASURFMENT VERTICAL DEVIATION 
FROM EORESIGHT - START (RAD) 

EDHS » LSTIMATEO STAR MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RAD) 

EOVS * ESTIMATED star measurement vertical 
DEVIATION FROM 80RESIGHT (RAD) 

MS * STAR MEASUREMENT UNIT VECTOR (SECOND 

SUBSCRIPT REFERS TO TRACKER) - START 
RS * STAR MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - START IRAQ#. 2) 

DHCL * LANDMARK MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - LAMKT (RAD) 

dvcl « landmark measurement vertical deviation 

FROM EORESIGHT - LAMKT (RAD) 

EOHL * ESTIMATED LANDMARK MEASUREMENT HORIZONTAL 
deviation from boresight <rad> 

EDVL * ESTIMATED LANDMARK MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 

LMU « LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

RL r LANOMARK MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - LAMKT (RA0*»2) 


n rue uc r nu 



START 


S- „pr-1 981 14:56:22 
9-F*b-1981 10:22:05 


VAX-11 FORTRAN V2.0-2 
_DBA0: [01 1R.CCPJSTART.F0R; 12 


Pfc B® 3 


05200 

0013 


U< 1 )«0 . 

05300 

0014 


U ( 2 ) >0 . 

05400 

0015 


U( 3 } s 1 . 

05500 


c* ••• 


05600 


C 

ADD BIAS AND NOISE TO THE 10EAL MEASUREMENT AND 

05700 


C 

SUBTRACT OFF BIAS KNOW l EDGE 

05800 


c* ••• 


05900 

0016 


DO 10 I«1.2 

06000 

0017 

10 

MSI I .K )«U( I I +8S1 I .K J+GAUSS10. , SSI I , K ) J-BSK ( I ,K J 

06100 


c* 


06200 


c 

NORMALIZE the vector 

06400 

0018 


MS ( 3 . K ) .SORT ( 1 .-M^l 1 . K ) « • 2-MS ( 2,K)«*2) 

06500 

0019 


0VCS1K 1 .AS I N 1 MS 1 1 .¥.)} 

06600 

0020 


OHCS(K ).ASIN(MS(2 . K ) /COS ( DVCSI K) ) ) 

06700 


c* ••• 


06800 


C 

GENERATE STAR TRACKER NOISE COVARIANCE 

06900 


c* ••• 


07000 

0021 


DO 20 1.1.2 

07100 

0022 


DO 20 J«1 .2 

07200 

0023 

20 

RSI I . J ,K)«0. 

C7300 

0024 


DC 30 I«1 ,2 

07400 

0025 

30 

RSI I , I , K ) «SS K( I , K } * *2 

07500 

0026 


RETURN 

07600 

0027 


END 


— program sections 


At t r I but** 


0 SCOOE 

1 SPOATA 

2 SLOCAL 

3 debug 

4 STARPAR 

5 MEASOUT 


PIC CON REl LCL SHR EXE 
PIC CON REL LCL SHR NOEXE 
PIC CON REL LCL NOSHR NOEXE 
PIC OVR REL GBL SHR NOEXE 
PIC OVR REL G8L SHR NOEXE 
PIC OVR REL GBL SHR NOEXE 


RD NOWRT LONG 
RD NOWRT LONG 
RD WRT QUAD 
RD WRT LONG 
RD WRT LONG 
RD WRT LONG 


ENTRY POINTS 


Address Typ* Nam* 
0-00000000 START 


VARIABLES 


Address 

Typ* 

Nam* 

Add-ess 

T yp« 

Nam* 

Address 

Type 

Nam* 

5-000001 EO 

R*8 

DHCL 

5-030001 E8 

R *8 

DVCL 

5-00000278 

R*8 

EDHL 

2-00 0000 1C 

1*4 

I 

3-00000004 

1.4 

I DEBUG 

3-00000000 

1*4 

I ENTER 

2-00000020 

I *4 

J 

AP -00000034* 

1*4 

K 





Address Type Nam* 

5-00000280 R*8 EDVL 

2-00000018 1*4 IFLAG 


START 


6-Apr-19B1 14:56:22 
9-Feb-1981 18:22:05 


VAX-11 FORTRAN V2.0-2 
_0BA0:[D1 1R.GCPJSTART.F0R; 12 




ARRAYS 


Address 

T ype 

Name 

Bytes 

D i mens 

tone 

4-00 000000 

R • 8 

BS 

32 

(2 . 

2) 


4-00000160 

R*8 

bsk 

32 

( 2 . 

2) 


5-00000150 

R*8 

OHCS 

16 

(2) 



5-00000160 

R*8 

OVCS 

16 

(2) 



5-00 000258 

R«8 

EOMS 

16 

(2) 



5-00000268 

R«8 

EOVS 

16 

(2) 



5-00000228 

R • 8 

EMXG 

48 

(6) 



5-00 000 1 F 0 

R*8 

LMU 

24 

( 3 ) 



5-00000170 

R*8 

MS 

48 

( 3 . 

2) 


5-00000000 

R»8 

MX 

48 

(6) 



5-00 C00030 

R*8 

RGPS 

288 

(6, 

6) 


5-00000208 

R*8 

RL 

32 

(2. 

2) 


5-00 0001 AO 

R*8 

RS 

64 

(2 . 

2, 

2) 

4-00000020 

R*8 

SS 

32 

(2. 

2) 


4-00 000 180 

R*8 

iSK 

32 

(2 , 

2) 


4-00000000 

R»8 

TONS 

1 44 

(3. 

3. 

2) 

4-00000040 

R»B 

TNS 

1 44 

(3. 

3. 

2) 

4-00 r 001 AO 

R«B 

TNSK 

1 44 

! 3 . 

3. 

2) 

2-00 000000 

R*8 

U 

24 

(3) 




LABELS 

Address Label Address Label Address Label 

• • 10 •• 20 •• 30 


FUNCTIONS ANO SUBROUTINES REFERENCED 

GAUSS MTHSOASIN MTMSDCOS MTHSOSQRT 


Total Space Allocated » 1566 Bytes 


COMMANO QUALIFIERS 

fortran /list GCP. I noa t a.mat ab, OUT oat A, RUNG, on av,ephem,truea,srress,oc CULT, GPERT.GCPSEQ. VI si ble.genenv.tr eg. gyrout, rate, bmat.cma 

/CHE CK* ( NO SOUNDS . OV E R F LOW ) 

/DEBUG* ( NOSYMBOL S , TRACE8ACK ) 

/F77 , NOG_FLOAT ING /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE .CODE /CONT INUATIONS-19 


COMPILATION STATISTICS 


Run T 1 me : 
Elapsed Time: 
Page Faults: 
Dynamic Memory: 


1 . 55 seconds 
15.94 seconds 
355 

160 pages 


m mm m ■» m mmm§ w ■ ■ w — 




2.6.3 Landmark Tracker Model (LAMKT) 


Subroutine LAMKT simulate. a f ixed‘co“ d ini rough 

subtracting from the landmar P° landmark tracker coordinatea 

The line-of-sight vector i. tr.nefomed to DV KllureHD t. are 

where it ie normaliaed to a * - t ctor . ibe.e DH and DV 

computed based on the computed Une-o gh COBpen aated by subtraction 

S32 » 

through common. 


Processing Requirements 


The landmark location on the 
Coordinates (Figure Vll) will be 
earth's mean radius. 

[* l \ 


iL 


0 

0 


surface of the earth in Local Landmark 
a function of the altitude U L ) above the 




WWCVCI I , 

radius (te) added to the altitude, 
landmark to earth fixed coordinates produces 

f r E + a l' 

0 

0 


Lj “ E T L II = E T L 


(r E + Al) 


CLCX -SL 
SLCX CL 

L SA 0 



* 1 ■ 


0 

J 

0 


- (r E + A l ) 


CLC) 

SLCX 

SX 


L “* 

• .-An? the noaition vector of the spacecraft (Ps/c). wbe “ 

«. — fr *“' - iu provid * 

the measureuient vector (M). 


Mi - (i t eLe) “ Is /Cl 

Accounting for hardware misalignments, the same measurement vector in landmark 
tracker coordinates is: 

Mf - *Ti ((iTeLe) - IS/ Cl) 


- £Te^e - TxPs/Cl 
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Fro* examination of Figure A-33 , the unit measurement vector in landmark 
tracker coordinates is: 


Ui 




Uix' 


SinAV 

. 

UHy 


CosAVSinAH 


Viz 

m «■ 


-CosAVCosAH 


However, the tracker instrument has no 
boresight axis. Therefore, the tracker 


sensitivity to projections along its 
response to the unit vector will 


be: 


u'n - 

UJlx" 


SinAV 


Ufcy 

* 

CosAVSinAH 


producing aAH andAV as shown in Figure A-33 
sensor output will be corrupted by bias and 
be: 


as sensor outputs. Since the 
noise, the sensed measurement will 


AHs“ 


AH + bR + Vr 

AVs, 


AV + by + Vy _ 


Where: 


bR, by ■ Component landmark tracker bias. 

V H , v v - Component landmark tracker aero mean random noise, 


( 0 , ° 2 ) • 


The component biases and standard deviations (o> are user .electables 


The landmark tracker measurement may be compensated for k " owle J ge . 

instrument bias. The bias knowledge may be a priori or through estimation. 
Tbe compensated sensor output will be: 


A 

lx 


AHc 

_AVc 


AHs - Dr 
AVs - by 


Where: 

LH " the landmark being used 


f (L, X, Al) 
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a l 

L 

X 

L 

Zs/c 

A s/c 

M 

U 

H 

V 


the altitude of the landmark above the mean radio* of the earth 
longitude of the landmark 

latitude of the landmark , .. 

vector position of the landmark relative to the center of the 


earth . _ * ... „ 

vector position of the apacecraft relative to the center of the 

earth . 

altitude of the spacecraft above the mean radius of the eerth 
measurement vector from the spacecraft to the landmark 

unit vector along M , 

the landmark tracker horizontal plane angular deflection from 

the boresight axis 

the landmark tracker vertical plane angular deflection from the 


boresight axis 
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SUBROUTINE LAMkT 

landmark tracker 
knowledge OF ThE 
AND ALTITUDE I PER 
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TRACKER COORDINAT 
Br SUBTRACTING Tm 
FOR KNOWN LANOMAR 
RESULTING VECTOR 

INRUT VAR I AB L S 
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AL 
LON 
LAT 
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T BN L 

TNL » 

BL 

SL 
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SKL 

TNLK 

SIGGCP • 

OUTPUT VARIABLES 
OMCL 
OVCL 
LRU 

RL • 


SIMULATES A MEASUREMENT MADE BY THE 
IT DCES SO 3 Y SUBTRACTING E ROM PERFECT 
LANDMARK POSITION I LONGITUDE. LATITUDE. 
FECT knOkLEDGE OF THE SPACECRAFT POSITION. 
AS AND NOISE ARC AOOED WHILE IN LANDMARK 
EG. COMPENSATION FOR KNOWN BUS IS MADE 
IS KNOWLEDGE AT THIS POINT. COMPENSATION 
K TRACKER MISALIGNMENT IS MADE WHEN THE 
IS TRANSFORMED BACK TO INERTIAL SPACE. 


AVERAGE RADIUS OF THE EARTH (KM) 

landmark altitude <km) 
landmark LONGITUDE (DEG) 

LANDMARK LATITUDE (DEG) 

TIME ( TBD I 

SPASECRAFT POSITION VECTOR (3*1) (KM) 
EXACT INERTIAL TO BODY &UATERNIAN (4*1) 
LANDMARK TRACKER ORIENTATION ARRAY 
(NOMINAL TO BOOY ) (3*3) 

LANDMARK TRACKER MISALIGNMENT ARRAY 
(TRACKER TO NOMINAL) (3*3) 

LANDMARK TRACKER BUS (2*1) (RAD) 

LANDMARK TRACKER NOISE STANDARD DEVIATION 
(2*1) (RAO) 

LANDMARK tracker BUG KNOWLEDGE (2*1) 
(RAD) 

landmark tracker noise standard 
DEVIATION (2*1 ) (RAO) 

LANDMARK TRACKER MISALIGNMENT KNOWLEDGE 
ARRAY (TRACKER TO NOMINAL) (3.3) 
POSITION UNCERTAINTY DUE TO CLOUDS 


LANDMARK HORIZONTAL DEFLECTION (£•.?; 
LANDMARK VERTICAL DEOLECT ION (RAD) 
SIMULATED LANOMARK TRACKER UNIT VECTOR 
TO LANDMARK ( 3*1 ) 

LANOMARK TRACKER MEASUREMENT COVARIANCE 
(3*3) (RAD) 


FRJGRAMMEO BY UACK MYERS 11JUNE1M0 
EXT 4443 


COMMON BLOCKS 
INCLUOE ’ENVIR.COM' 

COMMON /ENVU/ STAT£( 10) . PROF ILE(10,4),INIT 
RE AL*B STATE. PROFILE 

REAL WORLD STATE PARAMETERS 

STATE STATE VALUES; X , T ,Z , XO, YD. ZD, EO . E 1 , E2 . E3 


Page 


VAX-11 FORTRAN V2.0-2 
_DBAO: [D1 1 R . GC P ) I **.,kT . FOR ; 21 


Pag* 2 


LAMKT 


6-Apr-l 9B1 
6- Jan- 1 981 


14:55:00 

12:48:32 


05200 

05200 

05200 

05200 

05200 0005 

00100 

00200 0006 
00300 

00400 0007 

00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
> 02000 
flj 02100 
O 02200 
u ’ 02300 
02400 
02500 
02600 

05300 0008 

00100 0009 

00200 

00300 

00400 

00500 

00600 

00700 

05400 0010 

00100 0011 
00200 

00300 0012 

00400 
00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 


C 

C 

C 

C 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


PROFILE ATTITUDE PROFILE-TIME (SEC) vs 

INERTIAL ANGULAR RATES (RAD/SEC) 

INIT INTEGRATION INITIALIZATION KEY (-1) 

INCLUOE 'TIME.COM' 

COMMON /TIME/ T IME . T NEXT . T STOP . T I A , DEL . T IN . DTN , DAT EO , TZE RO 
. , TME AS. TRACK ,TIS,TISN,DTA,DATER.TPRINT.DTPRINT 

REAL'S TIME.TNEXT .TSTOP, TI A.DEL . 1 IN , DTN , DATEO , TME AS . TRACK , T I S . 

. TISN.DTA, TZERO.DATER.TPRINT.DTPRINT 

THESE ARE THE TIME REFERENCE FRAMES 

TIME 
TNEXT 
TSTOP 
TIA 

0 L 
TIN 
OTN 
DATEO 
DATER 
TZERO 
TSLEW 
T1S 
TISN 
DT A 

TPRINT 
OTPRINT 

INC'-JDE 'DEBUG.COM ' 

COMMON /DEBUG/ I ENTER . IOEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

1 NTER IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
IOEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

INCLUOE 'LMTPAR.COM' 

COMMON /LMTPAR/ A L . LON . L AT , TBnL ( 3 , 3 ) , TNL ( 3 . 3 ) , BL ( 2 ) , SL ( 2 ) , 

BKL( 2) ,SKL(2).TNLK(3,3),TIE0(3,3) .SIGGCP.THET 
REAL'S AL.TBNL.TNL .BL.SL , BKL , SKL , TNLK . T I EO .SIGGCP.LAT. LON, 

THET 


ATOMIC TIME SINCE INITIALIZATION (SEC) 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

RUN TERMINATION TIME (SEC) 

ATTITUOE INTEGRATION TIME (SEC) 

* * STEP SIZE (SEC) 

POSITION INTEGRATION TIME (SEC) 

- * STEP SIZE (SEC) 

DATE OF FLIGHT EPOCH (JD) 

DATE OF 1950 EPOCH (JD) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

REAL WORLO REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY + DEL BUT ♦ TSLEW - TIA WHEN DEL 
TOO LARGE AT MEASUREMENT TIME 
TIME FOR PRINT (SEC) 

INCREMENT ON TPRINT (SEC) 


LANOMARK TRACKER PARAMETERS 


AL 

= 

ALTITUDE OF LANDMARK (KM) 

LON 
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LONGITUDE OF LANDMARK (DEG) 
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LATITUDE OF LANDMARK (DEG) 
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ORIENTATION ARRAY FOR LANDMARK TRACKER 
NOMINAL TO BODY 
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MISALIGNMENT ARRAY - ACTUAL 
TRACKER TO NOMINAL 

BL 
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BIAS - ACTUAL (RAD) 
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* 

NOISE STANOARO DEVIATION - ACTUAL (RADI 

BKL 
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BIAS - KNOWLEDGE (RAO) 


LAMKT 
01 BOO 


• 

c 

01900 


• 

c 

02000 


• 

c 

02100 


• 

c 

02200 


• 

c 

02300 


• 

c 

02400 


• 

c 

02500 


* 

c 

05500 

00100 

0013 

0014 

• 


00200 

00300 

00400 

0015 

• 

• 

• 


00500 

00600 


• 

• 

C 

00700 


• 

c 

00800 


• 

c 

00900 


• 

c 

01000 


• 

c 

01100 


• 

C 

01200 


• 

c 

•0 1300 


• 

c 

01400 


• 

c 

01500 


• 

c 

01600 


• 

c 

01700 


• 

c 

01800 


• 

c 

01900 


• 

c 

02000 


• 

c 

02100 


• 

c 

02200 


* 

c 

02300 


• 

c 

02400 


• 

c 

02500 


• 

c 

02600 


• 

c 

02700 


• 

c 

02800 


• 

c 

02900 


• 

c 

03000 


• 

c 

03100 


• 

c 

03200 


* 

c 

03300 


* 

c 

03400 


• 

c 

03500 


• 

c 

03600 


• 

c 

03700 


• 

c 

03800 


• 

c 

05600 

05700 

0016 

• 

c 

05700 

0017 

• 


05700 

0018 

* 


05700 


• 

c 

05700 


• 

c 

05700 


* 

c 

05700 


• 

c 

05700 


• 

c 

05700 


* 

c 


6-Apr— 1 981 14:55:06 VAX-11 FORTRAN V2.0-2 
6- Jan- 1981 12:4332 .DBAO: [01 1R.GCP] LAMKT . FOR; 21 


THET * LOOK ANGLE (RAO) 

SKL = NOISE STANDARD DEVIATION -KNOWLEDGE (RAD) 
TIEO « INiTIAL EARTH FIXED TO INERTIAL 
TRANSFORMATION 

TNLK = MISALIGNMENT ARRAY KNOWLEDGE 

TRACKER TO NOMINAL 

SIGGCP = POSITION UNCERTAINTY DUE TO CLOUDS 
INCLUDE ’MEASOUT.COM' 

COMMON /MEASOUT/ M X I 6 ) , RGPS (6,6), DHCS ( 2 ) , DVCS( 2 ) , MS( 3 , 2 ) . 
RS(2 .2,2) . DHCL.DVCL. LMU(3) , RL(2,2) ,EMXG(6) , 

EDHS ( 2 ) ,EDVS(2) . EOHL.EOVL 

REAL*B MX, RGPS, DHCS, DVCS , MS, RS, DHCL.DVCL, LMU.RL, EMXG, 
EDHS.-DVS.EDHL.EDVL 


MEASUREMENT 

MX 

EMXG 

RGPS 

DHCS 

DVCS 

EDHS 

EDVS 

MS 

RS 

DHCL 

DVCL 

EDHL 

EOVL 

LMU 

RL 


OUTPUT PARAMETERS 

* POSITION/VELOCITY STATE MEASUREMENT - GPS 

(KM, KM/SEC) 

« ESTIMATED POSITION/VELOCITY STATE 
MEASUREMENT - HGPS 

* STATE MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - GPS ( KM» *2 , KM/SEC* *2 ) 

« STAR MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - START (RAD) 

* STAR MEASUREMENT VERTICAL DEVIATION 

FROM BORESIGHT - START (RAD) 

* ESTIMATED STAR MEASUREMENT HORIZONTAL 

DEVIATION FROM BORESIGHT (RAO) 

* ESTIMATED STAR MEASUREMENT VERTICAL 

DEVIATION FROM BORESIGHT (RAO) 

C STAR MEASUREMENT UNIT VECTOR (SECOND 

SUBSCRIPT REFERS TO TRACKER) - START 

* STAR MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - START (RAD**2) 

* LANDMARK MEASUREMENT HORIZONTAL DEVIATION 

FROM BORESIGHT - LAMKT (RAD) 

» LANDMARK MEASUREMENT VERTICAL DEVIATION 
FROM BORESIGHT - LAMKT (RAD) 

* ESTIMATED LANDMARK MEASUREMENT HORIZONTAL 

DEVIATION FROM BORESIGHT (RAD) 

« ESTIMATED LANDMARK MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 

* LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

* LANDMARK MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - LAMKT (RA0**2) 


INCLUDE ’NSTATE.COM' 


COMMON /NSTATE/ XD< 6 ) , X ( 6 ) , RADM , RADE 
REAL'S XD,X, RADM, RADE 

POSITION STATE AND CONSIDERED PARAMETERS 


XD STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 
X STATE POSITION PARAMETERS (KM AND KM/SEC) 
RADM RADIUS OF THE MOON (KM) 
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EARTH DETECTABLE RADIUS (KM) 


INCLUDE ‘TARG TS.COM' 

COMMON /TARGETS/ MT 1 PE . I 5 . NS . JF L AG. MCOOE . P I , TPI 
LOGICAL JFLAG 
RE AL»8 PI, TPI 

MEASUH MENT SPECIFICATIONS 

MT <P£ MEASUREMENT TYPE 

JFLAG set fop star obstruction 

MCOOE * * MEASUREMENT PROCESSING 

PI PI 

TPI 2-PI 

EQUIVALENCE 13. STA t EC7ii.(P, STATE), (OELT,DELTL),(B.BL),(S,SL), 
<BK . ex L ) . I ,S»L ) . ( T . T IMt) , ( RE .RADE I 
DIMENSION LE<3).*.If3),MI13).T0L(3,3).TL8(3.3J,TBI(3,3),TLl(3,3) 
Ml I 3) . U¥L( 3 I . PI 3 I . T IE» 3. 3) 

REAL-8 DELT.D LT l . 0- . OV , RTD. TO , T IE , L£ , Li . M I ,ML , 

T8I.TBL,T L a,TcI . UML.B, BK.Q.RE , S , T ,P, GAUSS 
DATA IFLAG/O/ 


generate the landmark POSITION in earth fixed COORDINATES 


RTD-180./PI ' RADIAN TO DEGREE CONVERSION 

LEI 1 ) * I fi£*AL )*COS< lON/RT D) -COS ( LAT/R TD) 
LEI2J* IRE*AL l-SINi LCN/ R T D ) -COS ( LAT/R TO ) 
L£(3 )*IR£+AL)-SIN( lAT/BTO) 


BRING LANDMARK POSITION INTO INERTIAL SPACE 


CALL MET(TIEO.TIE) ! GENERATE TIE 

CALLMATABITI ,LE. LI ,3,3,1 ) 


SUBTRACT SPAC craft POSITION IN INERTIAL SPACE 


DO 10 I»1 .3 
Mil I )« LIE I )-P< I) 


TRANSFORM To LANDMARK THACKER COORDINATES 


CALL A MAT ( Q, T91 ) 

CALL MATABI TBNL. Tnl . TBL . 3,3,3 ) 
CALL MINV3(TB>. . TlB I 
CALL M»TA3! T LB. TBi . TLI , 3 .3,3) 
CALL MATABI T LI ,MI . Ml , 3. 3 , 1 ( 


formalize the measurement vector 


call unitiml ,UML. 3 ) 


GENERATE DH AND DV MEASUREMENTS FROM UNIT MEASUREMENT 
VECTOR 

OV«ASIN(UMl{ 1 ) ) 
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DH=ASIN(UML< 2)/C0S(DV) ) »*.*•*•••••**••*• 

CORRUPT THE M ASUREMENT VECTOR WITH BIAS AND NOISE AND 
COMPENSATE FOR THE BIAS KNOWLEDGE 

SLl 1 )* .001*S IGGCP/ VMAGIMI ,3) ICHANGE DISTANCE TO ANGLE IN RAD. 

SL( 2 ) = SL( 1 ) I DI !I° 

DHCL = DH+BL( 1 ) +GAUS b 'O..SL(1))“BKL(1) 

DVCL=D V+BLI 2 ) +GAUSS < 0 . . SL( 2 ) )-BKL( 2 ) 

RECONSTRUCT UNIT VECTOR FROM COMPENSATED MEASUREMENTS 
POSSIBLY NOT NEEDED AT THIS POINT 

|***«*»*»************** W W 

LMU ( 1 ) =COS(DVCL) •SIN(DHCL) 

LMU( 2 ) *SIN( DVCL ) 

LMU(3) -COS( D VCD -COStDHCL) 

FORM MEASUREMENT NOISE COVARIANCE 

DO 20 I«1 ,2 
DO 20 d«1 .2 
RL(I.d)-0. 

DO 30 1*1.2 

RL( I . I )*SL( I )*SL( I ) 

RETURN 

END 
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PROGRAM SECTIONS 


Name 

0 SCOOE 

1 SPDATA 

2 SLOCAL 

3 ENVIR 

4 TIME 

5 DEBUG 

6 LMTPAR 

7 MEASOUT 

8 NSTATE 

9 TARGETS 


Bytes 

At t 

501 

PIC 

12 

PIC 

740 

PIC 

404 

PIC 

136 

PIC 

8 

PIC 

392 

PIC 

648 

PIC 

1 12 

PIC 

36 

PIC 


i butea 

CON REL LCL 
CON REL LCL 
CON REL LCL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 
OVR REL GBL 


SHR EXE 
SHR NOEXE 
NOSHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 
SHR NOEXE 


RD NOWRT LONG 
RD NOWRT LONG 
RD WRT QUAD 
RD WRT LONG 
RO WRT LONG 
RD WRT LONG 
RO WRT LONG 
RD WRT LONG 
RD WRT LONG 
RD WRT LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 LAMKT 


tr 


lamkt 
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variables 


Address 

Type 

Name 

6-00000000 

R-8 

AL 

4-00000070 

R-8 

DATER 

2-00 0001 E8 

P • 8 

DM 

4-00000080 

R-8 

dtprint 

7-00000280 

R-8 

EDVL 

2-00000208 

;-4 

I flag 

9-00 30000C 

L-4 

uflag 

9-00000000 

1*4 

MTYPE 

8-00 000068 

fl-8 

RAOE 

6-00000088 

R-8 

S 

2-00000200 

r*b 

TO 

4-00000028 

R>8 

TIN 

4-00000008 

fl-8 

TNEXT 

4-00000010 

R-8 

TSTOP 

ARRAYS 

Address 

Type 

Name 


e-ooooooce 

R-B 

BKL 

6-000900A8 

R-8 

0L 

7-000001 50 

R-0 

DMCS 

7-00000160 

R-B 

DVCS 

7-00000258 

fl-8 

EDMS 

7-00000268 

R-8 

EDVS 

7-00000228 

fl-8 

EMXG 

2-00000008 

R-8 

LE 

2-00 000020 

fl-0 

LI 

7-000001 FO 

R-8 

LMU 

2-00000038 

P-8 

MI 

2-000001 7 0 

R-8 

ML 

7-00000170 

R-8 

MS 

7-00000000 

R-8 

MX 

3-00000000 

P-8 

P 

3-09 070050 

R-8 

PROFILE 

7-00000030 

R-8 

RGPS 

7-00000208 

R« 8 

RL 

7-000001*0 

p-a 

RS 

6-00000038 

R-B 

SKL 

6-00000088 

P-8 

SL 

3-00070000 

R-8 

STATE 

2-00 OOOOE 0 

R-8 

TBI 

2-00000050 

R*8 

TBL 

6-00000018 

P-8 

TBNL 

2-000001 AO 

R-8 

TIE 

6*00 COO 1 30 

P-8 

TIEO 

2-00000098 

R-8 

TLB 

2-00000128 

R-8 

TLl 

6-00 000060 

R-8 

TNL 

6-00 OOOOE8 

R-8 

TNL* 

2-00000188 

R-8 

uml 

8-00 000030 

R-8 

X 


Add'e'^s 

6- 000030*8 
4-00000020 

7- GCC00 no 

2 - 00000 1 FQ 
2-00000200 

3 - 00000 100 
6-00000010 
9-C0000008 

8 - 00000000 
6-00003 1 78 
6-00000 1 80 
4-00000058 
9 -00000 0 1 C 
4-00000040 


Type 

Nam* 

R-8 

8 

R-8 

DEL 

R-8 

OhCL 

B -8 

DV 

1 -4 

I 

I -4 

INIT 

R-8 

lat 

I -4 

NS 

R-8 

raom 

R-8 

SiGGCP 

R-8 

THET 

R-8 

TIS 

R-8 

TPl 

R-B 

TZERO 


Bytes Oi"**f 1 »'on* 


16 

<21 

16 

< 2) 

16 

1 2 ) 

16 

<2) 

16 

< 2 ) 

16 

(2) 

48 

<6 1 

24 

<3 ) 

24 

(3) 

24 

< 3 ) 

24 

<31 

24 

< 3 ) 

40 

<3. 2) 

48 

(6 ) 

24 

(3) 

320 

( 1 0, 4) 

2 88 

< 6 . 6) 

32 

<2, 2) 

64 

<2. 2. 

16 

<21 

16 

< 2 ) 

83 

(10) 

"2 

■ 7 . 3) 

72 

(3 . 3) 

72 

<3. 31 

72 

(3. 3) 

72 

<3, 3) 

72 

<3. 3) 

72 

<3, 3) 

72 

<3. 3) 

72 

(3. 3) 

24 

(3) 

48 

(6) 


Address 

T ype 

Name 

6-00000068 

R-8 

BK 

2-00000700 

B-8 

DELT 

4-00000068 

B-8 
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2.7 Perform State Estimation (EST) 

EST incorporates the latest GPS, star tracker, and GCP measurements into 
an estimate of the spacecraft state using an extended Cariaon Square Root 
filter. The extended filter incorporates propagation of the state, the state 
transition matrix, and the process noise through integration of non linear 
differential equations. The square root filter has been selected to overcome 
numerical difficulties associated with small spacecraft computers. 

The process, illustrated in Figure A-35 begins by constructing a 
single composit state out of navigation and attitude states. The two portions 
of the state were separated because they are propagated in dramatically 
different ways. The navigator state, X, is propagated through non-linear 
integration of the equations of motion while the attitude stae, E, is 
propagated by the gyros. Similarly the composite state transition and 
covariance matrices are constructed from the attitude and position 
components. The last composite array to be found is the process noise. 
However, the attitude portion of the process noise array is loaded with zeros 
because it was previously considered in gyro processing. After the composite 
process noise array has been loaded, the navigation process noise array is 
reinitialized to zero for the next measurement interval. 

Following construction of the composite arrays, the covariance matrix is 
propagated forward to current time by the subroutine PROP. PRO? uses the 
state transition matrix PHI to perform this function. PROP also reinitializes 
the state transition matrix to the identity matrix, and EST loads the 
independent attitude and navigation state transition matrices. 

The measurement partials and the estimated measurement are computed by 
MPART. MPART uses the measurement code to determine which partials to 
generate. These partials are used along with the measurement residual, to 
estimate the state of the spacecraft. This process is performed in a 
systematic manner. First, the measurement residual is computed by subtracting 
the estimated measurement vector from the true measurement vectors. Each 
component of the measurement residual is used sequentially in a two step 
process to update the state and covariance and to reload the old covariance. 

It is necessary to reload the old covariance between each update because the 
original old covariance is no longer valid after one update. 

Following state update, the navigation and attitude states are loaded with 
the new state estimate. The attitude quaternions are unitized to insure 
orthogonality, and the various transformation matrices are computed. 

The final procedure in EST is to insure that the attitude covariance does 
not drop below some minimum required to insure stability. If the covariance 
were allowed to converge to zero, new measurements would be ignored and the 
state estimate would diverge. 
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BKL( 2 I , SKl ( 2 ) . TNLK(3,3),TI£0(3.3), SIGGCP , THCT 
REAL** AL.TBNL.TNL.BL.Sl . BKL , SKL . TNLK . TIEO , S IGGCP , LAT , LON, 
TMET 


LANOMARK TRACKER PARAMETER: 

AL « ALTITUDE OF LANOMARK (KM) 

LON - LONGITUDE OF LANOMARK (DEG) 


EST 




6-Apr- 1961 14:56:03 < 





3-Apr— 1 961 09:41:46 

01000 


• 

c 

LAT • LATITUDE OF LANOMARK ( DC G ) 

01100 


• 

c 

TONI ■ ORIENTATION ARRAY FOR LANDMARK TRACKER 

01200 


• 

C 

NOMINAL to root 

01300 


• 

C 

TNL • MISALIGNMENT ARRAY - ACTUAL 

01400 


• 

c 

TRACKER to nominal 

01500 


• 

c 

OL • BIAS - ACTl'L (RAO) 

01000 


• 

c 

SL « NOISE STANDARD DEVIATION - ACTUAL (RAD) 

01700 


• 

c 

6ML * BIAS - KNOWLEDGE (RAO) 

01000 


• 

c 

THE T * LOOK ANGLE 1 RAO) 

01900 


• 

c 

SKL • NOISE STANDARD DEVIATION -KNOWLEDGE (RAO) 

02000 


• 

c 

TIEO - INITIAL EARTH F!XEO TO INERTIAL 

02100 


• 

c 

TRANSFORMATION 

02200 


• 

c 

TNLK > MISALIGNMENT ARRAY KNOWLEOGC 

02300 


• 

c 

tracker to nominal 

02400 


• 

c 

SIGGCR * POSITION UNCERTAINTY DUE TO CLOUDS 

02500 


e 

c 


05200 



c 


05300 

0053 



I F ( I ENTER .£0. 1) WR1TE(6.1) MCOOC 

05400 

(054 


1 

FORMAT ( 1 ENTERING EST WITH MCOOC ■ ’.12) 

05500 

0055 



DO 3 1-1.6 

05000 

0056 



KT(I)-K(I) 

05700 

0057 


3 

IP(t)-lPN<t) 

05000 

0056 



DO 4 1-7.10 

05900 

0059 



XT(l).EU-O) 

OOOOO 

0060 


4 

IPII).IPA(--O) 

06100 

0061 



00 5 I-1I..J 

06200 

0062 



IP( I ) • I PA( 1 — 6) 

06300 

0063 


5 

XT ( I ) -0. 

06400 



C 


06500 



c* ••• 


06600 



c 

CONSTRUCT COMPOSIT STATE TRANSITION MATRIX ANO OLD COVARIANCE 

06700 



c- • •• 


06000 



c 


06900 

0064 



DO 20 1-1.22 

07000 

0065 



DO 20 J-1,23 

07100 

0066 


20 

PHI ( 1 . J ) -0 • 

07200 

0067 



DO 30 1-1.6 

07300 

0066 



DO 30 «l«1 .6 

07400 

0069 



P01 I . J ) -PON( I.J) 

01500 

0070 


30 

PHI ( I • J ) -PN( I.J) 

07600 

Ol»T 1 



00 40 1-7,22 

07700 

0072 



DO 40 J-7.22 

07000 

0073 



POI I.J ) «POA( 1-6. J-6) 

07900 

0074 


40 

PHI (I.J ) -PHI A( 1—6 , d“6) 

06000 



C 


06100 



o ••• 


06200 



c 

ZERO ATTITUDE PORTION OF PROCESS NOISE SINCE IT WAS CONSIDERED 

06300 



c 

IN THE GYRO MODEL 

06400 



c 

FORM TOTAL PROCESS NOISE ARRAY 

06500 



c- ••• 


00600 



c 


00700 

0075 



DO 70 1-1.6 

00600 

0076 



DO 70 d-1,6 

00900 

0077 


70 

OT(I.d)-D(I. J) 

09000 



c 


09100 



c- ••• 


09130 



c 

ZERO NAV PROC.SS NOISE 


VAX-11 FORTRAN V2.0-2 
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Ng« • 


EST 


6-App-1981 14:58:03 
3-Apr-1 981 09:41:45 


VAX-11 FORTRAN V2.0-2 
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> 

NJ 


09300 


C*< 

09400 


C 

09500 

0078 


09600 

0079 


09700 

0080 

75 

09800 


C 

09900 


C. « 

10000 


C 

10100 


C*« 

10200 


C 

10300 

0081 


10400 


C 

10500 


c« « 

10600 


c 

10700 


c» • 

10800 


c 

10900 

0082 


11000 

0083 


1 1100 

0084 

80 

11200 

0085 


11300 

0086 


11400 

0087 

90 

11500 


c 

11600 


c* • 

11700 


c 

1 1800 


c*« 

11900 


c 

12000 

0088 


12100 


c 

12200 


c* • 

12300 


c 

12400 


c* * 

12500 


c 

12600 

0089 


12700 

0090 


12800 


c 

12900 


c« * 

13000 


c 

13100 


c* • 

1 3200 


c 

13300 

0091 

100 

13400 

0092 


13500 

0093 


13600 

0094 


13700 

0095 


13800 

#096 

150 

13900 

#097 

151 

14000 

0098 


14100 

0099 


14200 

0100 


14300 

0101 


14400 

0102 


14500 

0103 


14600 

0104 

152 

14700 

0105 

155 

14800 

0106 

153 

14900 

0107 

154 


DO 75 I«1 ,6 
DO 75 u«1 ,6 
Q( I , J) *0. 


PROPAGATE COVARIANCE ARRAY 


CALL PROP! 10 ,22. PHI .COV. PO.QT, P) 


PARTITION INITIALIZED P INTO PN AND PA 


00 80 1.1,6 
00 80 J»1 ,6 
PN<I , J)*P(I , J) 

DO 9C I«7, 10 
DO 9C J«7,10 
PA(I-6,J-6)«P(I,J) 


ESTABLIS# MEASUREMENT PARTIALS 


CALL MPART 


BRANCH TO THE APPROPRIATE UPDATE MODE 


GOTO (100,200.300,400). MCODE 
RETURN 


CALCULATE ACTUAL-PREDICTED MEASUREMENT - LANDMARK TRACKER 


OZHLM=DHCL-EDHL 

DZVLM=DVCL-EOVL 

I F( I OE BUG . L T . 4) GO TO 170 

WR I TE ( 6,1 50 ) OZHLM.OHCL.EDHL 

WRITE(6,15H DZVLM.OVCL.EOVL 

FORMAT (' DZHLM.DHCL.EDHL ',3E20.10) 

FORMAT ( 1 OZVLM , DVCL , EOVL ',3E20.10) 

WRITE! 6,155) 

WR I TE ( 6 , 1 52 ) (POHL( I ) . I«1 ,10) 

WR I TE ( 6,153) 

WR I TE ( 6, 1 52 ) (POVL(I).I.I ,10) 

WRITE! 6, 154 ) 

WR I TE ( 6,1 52 ) (XT (I), 1.1, 10) 

F0RMAT(5X,5E 15.7) 

FORMAT (' P DHL ’ ) 

FORMAT!’ POVL 1 ) 

FORMAT (’ XT ') 










EST 


6-Apr-1981 14:58:03 
3-Apr-19Bt 09:41:45 


VAX-11 FORTRAN V2.0-2 
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> 

1 

isj 

S) 

o 


15000 


C 

15100 


c* • »* 

15200 


c 

15300 


c* 

15400 


c 

15500 

0108 

170 

'5600 

0109 


15700 

0110 


15800 

01 1 1 

160 

15900 

0112 


16000 

0113 


16100 


C 

16200 


c« •• 

16300 


c 

16400 


c* •• 

16500 


c 

16600 

0114 

200 

16700 

0115 

20 5 

16800 


C 

16900 


c* •• 

17000 


c 

17100 


c* •• 

17200 


C 

17300 

0116 


17400 

0117 


17500 

0118 


17600 

0119 

21 0 

17700 

0110 


17800 

01 .’1 


17900 

01*2 


18000 

0123 


18100 

0124 

22 0 

18200 

0125 


18300 

0126 


18400 

0127 


18500 

0128 


18600 

0129 

230 

18700 

0130 


18800 

0131 


18900 

0132 


19000 

0133 


19100 

0134 

240 

19200 

0135 


19300 

0136 


19400 

0137 


19500 

0138 


19600 

0139 

250 

19700 

0140 


19800 

0141 


19900 

0142 


20000 

0143 


20100 

0144 

599 

20200 

0145 


20300 


C 

20400 


c* • 

20500 


c 

20600 


c*» 


MAKE UPDATE - LANDMARK TRACKER 

CALL UPDATE! 22,10. XT , COV , PO , POHL ,RL! 1 . 1 I . OZMLM, IP) 
DO 160 1*1.22 
DO 160 d*1 .22 

CALL UPDATE! 22,10 , XT ,C0V , PO . POVL ,Rl( 2 , 2) ,0ZVLM, IP) 
GO TO 600 

# # 0 # 0 # 0 0 0 000040 «•**••«•****• 01 

CALCULATE AC TUAL-PREOICTED MEASUREMENT - GPS 


DO 205 1*1 .6 

OXMGPS ( I ) *MX ( I l-EMXG! I ) 


MAKE UPOATE - GPS 

CALL UPDATE 122.10. XT. COV. PO.PX. RGPS! 1.1). OXMGPS! 1). IP) 

DO 210 1*1.22 
DO 210 d*1 .22 
PO! I . J )*COV! I . J) 

CALL*uPOATE( 22 . 1 0 , XT ,COV , PO. PY « ROPS( 2.2) , OXMGPS! 2) ■ IP) 

DO 220 1*1.22 
DO 220 d*1 .22 
PO! I . J ) *C0V ( I .d) 

call UPDATE! 22.10. XT , COV , PO « PZ ,RGPS| 3.3) .OXMGPS! 3) .IP) 
DO 230 1*1 .22 
DO 230 d*1 ,22 
PO! I .d )*COV( I , J) 

CALL*UPDATE! 22,10, XT , COV , PO, PXO, RGPS"! A ,4) , DXMGPS (4) , IP ) 
DO 240 1*1.2? 

OO 240 d*1 .22 
PO! I .d ) *COV ! I ,d) 

CALL*UPDATE! 22 , 10 . XT ,COV , PO, PYO, RGPS ! 5 ,5 ) , OXMGPS ( 5) , IP ) 
00 250 1*1 .22 
DO 250 d*1 .22 
PO! I . d )*COV( I ,d) 

CALL UPDATE! 22 , 10 . XT ,COV , PO, PZO , RGPS! 6 ,6) , DXMGPS! 6) , IP ) 
Z6*GAI N( 6) _ „ „ 

WRITE! 13.599 ) TIME, Z1 .Z2.Z3.Z4.25.Z6 

FORMAT (7F14.7) 

GO TO 600 

CALCULATE ACTUAL-PREDICTED MEASUREMENT - STAR TRACKER 1 


Pag* 
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EST 


6-Apr-1 901 
3-Apr- 1 981 


14:58:03 
09:41 : 45 


20700 


C 


20800 

0146 

30 0 

PZHST1 *DHCS( 1 )-EDHS< 1 ) 

20900 

0147 


DZVST1 *DVCS( 1 )-EOVS< 1 ) 

21000 


C 


21100 


(>•••• 


21200 


c 

MAKE UPDATE - STAR TRACKER 1 

31300 


<>•••« 


21400 


c 


21500 

0148 


CALI UPDATE( 22 , 1 0 . XT ,COV , PO, POHS( 1,1),RS (1,1,1), DZHST 1 , IP) 

21600 

0149 


DO 310 1.1.22 

21700 

0150 


DO 310 J.1 .22 

21800 

0151 

31 0 

PO(I.J).COV( I.J) 

21900 

0152 


CALL UPDATE! 22 . 1 0 , XT , COV , PO. POVS( 1 , 1 > , RS( 2 , 2 , 1 ) , DZVST 1 . IP) 

22000 

0153 


GO TO 600 

22100 


C 


22200 


(>••••' 


22300 


c 

CALCULATE ACTUAL-PREDICTED MEASUREMENT - STAR TRACKER 2 

22400 




22500 


c 


22600 

0154 

40 0 

DZHST2 *DHCS( 2)-E0HS<2) 

22700 

0155 


DZVST2 »DVCS! 2 ) -EDV5 ( 2 ) 

22800 


C 


22900 




23000 


c 

MAKE UPDATE - STAR TRACKER 2 

23100 


c* 


23200 


c 


23300 

0156 


CALL UPDATE! 22 . 1 0 . XT .COV . PO . POHS( 1 . 2 ) , RS< t . 1 , 2) . DZHST2 , I P) 

23400 

0157 


DO 4 1 0 1.1,22 

23500 

0158 


DO 410 J«1,22 

23600 

0159 

41 0 

P0( I . J )«COV( I.J) 

23700 

0160 


CALL UPDATE ( 22, 1 0 . XT ,COV , PO, PDVS! 1 , 2 ) , RS( 2 , 2 , 2 ) , DZVST2 .IP) 

23800 


c 


23900 




24000 


c 

FINISH 

24100 


(>••••« 


24200 


c 


24300 

0161 

60 0 

DO 650 I>1,6 

24400 

0162 

650 

X(1).XT(1) 

24500 

0163 


DO 700 I»7, 1 0 

24600 

0164 

70 0 

E(I-6)«XT!I) 

24700 

0165 


CALL UNI T ( E , E.4) 

24800 

0166 


CALL A MAT ( E . A ) 

24900 

0167 


CALL CMAT1SF ,D,C) 

25000 


C 


25100 


<>•••*< 


25200 


c 

KEEP ATTITUDE COVARIANCE FROM DROPPING TOO LOW 

25300 


(>••••* 


25400 


c 


25500 

0168 


CALL CRA1SE! 16.C0VA.0A, I PA) 

25600 

0169 


1 F ( I DE BUG .GT. 1) WR1TE{6,800) X.E 

25700 

0170 

80 0 

FORMAT!* EXITING FROM EST X. *,6E20.10,/. 

25800 


* 

' .« ' , 4E20 .10) 

25900 

0171 


1 F ( I DE BUG .GT. 1) WR I TE ( 6 , 900 ) (GAIN! I ) , I- 1 , 1 0 ) 

26000 

0172 

90 0 

FORMAT!' GAIN * . 5E1 5 . 7 , / , 1 5X ,5E15. 7 ) 

26100 

0173 


RETURN 

26200 

0174 


ENO 


est 


e-Apr-1981 14:58:03 
3“Apr-1 981 09:41:45 
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program sections 



Natie 

Bytes 

At t r i butes 







0 

SCOOE 

1631 

PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

1 

SPOATA 

232 

PIC 

CON 

REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

2 

SLOCAL 

664 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

MRT 

QUAD 

3 

OE BUG 

8 

PIC 

OVH 

REL 

G8L 

SHR 

NOEXE 

RD 

NRT 

LONG 

4 

TARGETS 

36 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

5 

PH I A 

7176 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

e 

GA IN 

176 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

7 

RESIDUALS 

96 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

e 

PH IN 

1440 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

9 

UPDT 

752 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

10 

astate 

160 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

1 1 

nstate 

112 

PIC 

OVR 

REL 

G8L 

SHR 

NOEXE 

RD 

MRT 

LONG 

12 

time 

136 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

<3 

tmat 

312 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

14 

FILTER 

88 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

15 

COMPOS IT 

1 9624 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

16 

ARRAYS 

1096 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

17 

PART 

2112 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

16 

MEASOUT 

648 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 

19 

LMTPAR 

392 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

MRT 

LONG 


ENTRY POINTS 


Address Type 

Name 

0-00000000 

EST 


VARIABLES 












Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

19-00000000 

R«8 

AL 

12-00000038 

R *8 

DATEO 

12-00000070 

R*8 

DATER 

12-00000020 

R*B 

DEL 

IB-00 0001EO 

R*8 

DHCL 

12-00000068 

R»8 

DT A 

12-00000030 

R*8 

DTN 

1 2-C0000080 

R • 8 

DTPRINT 

18-000001E8 

R*8 

OVCL 

7-00000000 

R*8 

DZHLM 

7-00000010 

R* 8 

DZHST1 

7-00000020 

R*8 

DZHST2 

7-00000008 

R*8 

DZVLM 

7-00000018 

R *8 

DZVST1 

7-00000028 

R*8 

DZVST2 

18-00000278 

R *8 

EDHL 

1 8—00 0002B0 

R*8 

EDVL 

2-00000018 

I«4 

1 

3-00000004 

I»4 

IDE BUG 

3-00000000 

I *4 

IENTER 

4-00000004 

1*4 

IS 

2-0000001C 

I *4 

d 

4-00 OOOOOC 

L»4 

jflag 

19-00000010 

R * 8 

LAT 

19-00OOOOO8 

R*8 

LON 

4-00000010 

1*4 

MCOOE 

4-00000000 

I»4 

MTYPE 

4-00000008 

1*4 

NS 

2-00000008 

R*8 

POHDX 

2-00000010 

R*8 

PDVDX 

4-00000014 

R*8 

PI 

5-00001 COO 

R • 8 

DM AX 

11-00000068 

R»8 

RADE 

1 1 -00000060 

R*8 

RA DM 

19-00000178 

R*8 

SIGGCP 

19-00000180 

R*8 

thet 

12-00000018 

R*8 

TIA 

12-00000000 

R*8 

TIME 

12-00000028 

R*8 

TIN 

12-00000058 

R»8 

TIS 

12-00000060 

R*8 

TISN 

12-00000048 

R *8 

TMEAS 

12-00000008 

R*8 

tnext 

4-0000001C 

R*B 

TP 1 

12-00000078 

R*8 

TPRINT 

12-00000050 

R*8 

TRACK 

12-00000010 

R*8 

TSTOP 

12-00000040 

R *8 

TZERO 

2-00000000 

R*8 

VOOT 

2-00000020 

R*4 

Z1 

2-00000024 

R»4 

Z 2 

2-00000028 

R*4 

Z3 

2-0000002C 

R»4 

24 

2-00000030 

R*4 

Z5 

2-00000034 

R»4 

ZB 





EST 


' 


ARRAYS 


Address Typ* Nan* 


1 3-00000000 

R*a 

A 

13-00000048 

R>8 

8 

19-OOOOOOC8 

R*8 

bkl 

19-000000*8 

R*8 

BL 

13-00000090 

R*8 

C 

1 5-00 00 1 E40 

R*8 

COV 

5-00 OOOCOO 

R*8 

COVA 

0-00000360 

R»0 

COVN 

10-00000070 

R»8 

0 

10-00000088 

R»8 

DO 

1 0-00 000000 

R *8 

CE 

18-00000150 

R*e 

DMCS 

18-00000160 

R*8 

ovcs 

7-00000030 

R*8 

DXMGPS 

10-00000020 

R*8 

E 

18-00000258 

R*8 

EDHS 

18-00000268 

R*8 

EOVS 

13-00000098 

R*8 

EM 

10-00000228 

R*8 

EMXG 

6-00000000 

R*8 

GAIN 

1 5-00 003C80 

I«4 

IP 

14-00000018 

1*4 

I PA 

1 4-00000000 

I»4 

IPN 

1 8-00 000 1 FO 

R*a 

IMU 

18-00000170 

R*8 

MS 

18-00000000 

R*8 

MX 

15-00003088 

R«a 

P 

5-00000000 

R*8 

PA 

5-00000200 

R»8 

POA 

1 7-000006EO 

R*8 

PDML 

17-00000420 

R»8 

PDHS 

8-00000120 

R»8 

PDN 

17-00000790 

R*8 

PDVL 

17-00000580 

R*8 

PDVS 

15-00000000 

R*8 

PHI 

5-00000400 

R*8 

Phi A 

8-00000240 

R*8 

PHIN 

8-00000000 

R*8 

PN 

15-00002060 

R*8 

PO 

5-00001400 

R*8 

POA 

8-00000400 

R*8 

PON 

1 7-00 000000 

R*8 

PX 

17-00000210 

R«9 

PXD 

1 7-00 OOOOBO 

R«0 

PY 

1 7-00 0002C0 

R*8 

PYD 

17-00000160 

R»8 

32 

17-00000370 

R*8 

PZO 

9-00 OOOOBO 

R*8 

0 

9-00000030 

R*8 

OA 

9-00000100 

R*8 

<3 DOT 

9-00000000 

R*8 

ON 

1 5-00 000620 

R*8 

or 

18-00000030 

R*8 

RGPS 


Bytes 

D i mens 1 on* 

72 

(3. 3) 

72 

(3. 3) 

16 

(2) 

16 

(2) 

72 

(3. 3) 

3872 

(22, 22) 

2048 

(16, 16) 

288 

(6, 6) 

24 

(3) 

24 

(3) 

32 

(4) 

16 

(2) 

16 

(2) 

48 

(6) 

32 

(4) 

16 

(2) 

16 

(2) 

96 

(4, 3) 

48 

(6) 

1 76 

(22) 

88 

(22) 

64 

( 16) 

24 

(6) 

24 

(3) 

40 

(3, 2) 

48 

(6) 

3872 

(22, 22) 

1 28 

(4. 4) 

512 

(4. 16) 

1 76 

(22) 

352 

(22, 2) 

288 

(6. 6) 

1 76 

(22) 

352 

(22, 2) 

3872 

(22, 22) 

2048 

(16. 16) 

280 

(6, 6) 

288 

(6. 6) 

38 72 

(22, 22) 

2048 

( 16 , 16) 

280 

<6, 6) 

1 76 

(22) 

1 76 

(22) 

1 76 

(22) 

1 76 

(22) 

1 76 

( 22) 

1 76 

(22) 

288 

(6, 6) 

1 28 

(16) 

288 

(6. 6) 

48 

(6) 

3872 

(22, 22) 

288 

(6, 6) 


6-Apn-19B1 14:58:03 
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VAX-11 FORTRAN V2.0-2 
_OBAO : [01 1R.GCP ]EST . FOR: 37 


Pag* 12 


18-00000208 

r*b 

RL 

18-000001 AO 

R*8 

RS 

10-00000058 

R*8 

SF 

1 9-00 000008 

R*e 

SKL 

1 9-00 0000B8 

R»8 

SL 

16-00000000 

R*8 

T 1 

16-00000090 

R»8 

Til 

16-00000018 

R*8 

T2 

16-00000030 

R*8 

T3 

16-00 OOOOEO 

R*8 

T 33 

16-00000048 

R*B 

T 4 

16-00000128 

R»8 

T44 

16-00 0003E8 

R*8 

T5 

16-00000408 

R*8 

T6 

16-000001 A8 

R*8 

T66 

16-00000428 

R*8 

T7 

16-000002C8 

R*8 

T77 

5-00000080 

R*8 

TA 

19-00000018 

R*8 

TBNL 

19-00000130 

R*8 

TIEO 

19-00000060 

R»8 

TNL 

19-000000E8 

R*8 

TNLK 

10-00000040 

R*8 

HD 

11-00000030 

R*8 

X 

11-00000000 

R*8 

XD 

15-00003CDB 

R*8 

XT 


32 

12. 

3) 

64 

(2, 

2. 2 

24 

(3) 


16 

(2) 


16 

(2) 


24 

(3) 


72 

(3. 

3) 

24 

(3) 


24 

(3) 


72 

(3. 

3) 

80 

(10) 

1 28 

(4, 

4) 

32 

(4) 


32 

(4) 


288 

(6, 

6) 

32 

(4) 


288 

(6. 

6) 

384 

(4. 

12) 

72 

(?. 

3) 

72 

(3. 

3) 

72 

(3. 

3) 

72 

(3. 

3) 

24 

(3) 


48 

(6) 


48 

(6) 


176 

(22) 


LABELS 

Address Lab* I 

1-00000000 1 1 
** 40 

1-00000023 150' 

* • 1 60 
.* 230 

*• 410 

1-OOOOOOCO 900' 


Address Label 

• • 3 

• * 70 

1-00000040 151’ 

0- 0000 032C 170 

• • 240 

1- 00000083 599' 


Address 

Label 

• * 

4 

• • 

75 

1-00000050 

152' 

0-00000368 

200 

• • 

250 

0-000005 A 7 

800 


Address 

Label 

*• 

5 

• • 

80 

1-0000006F 

153' 

« * 

205 

0-000004EB 

300 

* • 

650 


Address 

Label 

• • 

20 

#* 

90 

1-00000079 

154’ 

• • 

210 

• * 

310 

• * 

700 


Address Label 

.. 30 

0- 000001 CB 100 

1- 00000065 155' 

• • 220 

0- 0000054A 400 

1- 00000089 800' 


functions and subroutines referenced 


AMAT CMAT 


CRAISE 


MPART PRO* 


UNIT update 


Total Space Allocated • 36891 Byt*s 


command qualifiers 

FORTRAN /LIST GCP, INDATA.MATAB.OUTDATA.RUNG.DNAV 


EPH EM, TRUEA.SPR ESS. OCCULT ,GPERT , GCPSEQ 


VISIBLE .GENENV .TREG. GY ROUT .RAT E . BMAT , CMA 


/CHECK* (NO BOUNDS .OVERFLON) 

^"^^G^oSt^/M^/OPTIMIZE /WARNINGS /NOD.LINES /NOMACHlNE.COOE /CONT INUATIONS-19 


A- 2 2 5 
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EST 


6-Apr-19B1 1 4 ! 58503 
3 - Apr- 1 981 09=41:45 


VAX-11 FORTRAN V2.0-2 
_08A0: [01 1R.GCP]EST . FOR; 37 


COMPILATION STATISTICS 

Run Time: 

Elapsed Tim#: 

Page Faults: 

Dynamic Memory! 


6.96 seconds 
121.03 second* 
438 

160 pages 


2.7.1 Propagate Covariancea Module (PROP) 

The interdependence of the state parameters cause their uncertainty to 
grow with time. This growth in uncertainty (covariance matrix) is propagated 
to the measurement time by using the state transition matrix. 

The mathematical equation which is used to update the covariance matrix to the 
time of the measurement is 

P(tm) * $(tm> tm-l)‘ P(tm~l) • ♦(tm, tm-1)^ + Q 


where 

“ covariance matrix at time of measurement. 

P(t m -!) ■ covariance matrix after processing previous measurement, 
^m-l* tm-l) “ state transition matrix from time of previous 
measurement to time of present measurment. 

Q - noise matrix to account for model errors. 

Figure A-36 illustrates this process 
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6- Apr- I 981 15:00:06 
1 7 -Oc t — 1 980 15:00:16 


VAX-11 FORTRAN V2. 
_DBA0 : [ D 1 1R.GCP ]PR 


001 00 

0001 



SUBROUTINE PROPINS. N .PHI . PN , PO . <3 , PHI P ) 


00200 



C 

DIMENSION PHI ( N , N 1 , PHI N . N ) , PO( N,N),Q(N,N), PHI P( N ,N) ,8422) 


00250 

0002 



DIMENSION PH 1 1 22. 22 1 ,PN( 22.22 ) ,PO(22 .22) ,0< 22,22 ) ,PHIP( 22.22 ) .8(22) 


00300 

0003 



REAL'S 8.PHI.PHIP.PN.P0.0 


C0400 




t MAS PHIP(NS.NS) 


00500 



O •• 



00600 



c 

N TOTAL NUMBER OF ALLOWABLE PARAMETERS 


00700 



c 

NS NUMB R OF STATE PARAMETERS 


ooeoo 



c 

PHI STAT TRANSITION MATRIX 


00900 



c 

0 PROC S5 NOISE 


01000 



c 

PN NEM COVARIANCE MATRIX 


01100 



c 

PO OLD COVARIANCE MATRIX 


01200 



c 



01300 



c 



01400 



c 

NOTE: PN AND PO ARE THE SAME AT EXIT AND EQUAL TO 


01500 



c 

THE UPDATED COVARIANCE. PO IS 01 STROYED 


01600 



c 

BY INTERNAL PROCESSING. 


01700 



c 



01800 



c 



01900 



c 



02000 



c 

COVARIANCE PROPAGATION 


02100 



C«** 


»*• 

02200 

0004 



INCLUOE 'OEBUG.COM 1 


00100 

0005 

• 


COMMON /DEBUG/ IENTER , IDE BUG 


00200 


• 

c 



00300 


• 

c 

USER CONTROLLED PARAMETERS TO VARY OEBUG PRINT LEVEL 


00400 


• 

c 



0050 7 


• 

c 

INTER IF 1. PRINTS WHEN ENTERS MOST SUBROUTINES 


OOGvO 


• 

c 

I OEBUG 0-10, HIGHER NUMBED MEANS MORE PRINT 


00700 


• 

c 



02300 

0008 



DO 20 1 ■ 1 .N 


02400 

0007 



DO 10 d* 1 , N 


02S00 

0008 



B(J) • 0. 


02600 

0009 



DO 10 K« 1 ,N 


02700 

0010 


10 

B( J ) ■ B(d)*PHI( I,K)«PN(K, d> 


02800 

0011 



OO 20 L* 1 ,N 


02900 

0012 



PO(I.L) « 0. 


03000 

0013 



00 20 Mm 1 ,N 


03103 

0014 


20 

PO(I.L) * PO(I ,L)*8<M).PHI <l.M) 


03200 

0015 



DO 30 I * 1 ,N 


03300 

0016 



DO 30 dm 1 ,N 


03400 

0017 



IF (I.LE.NS.ANO.d.LE.NS) PO(I.d) ■ PO(I.d) ♦ 0(1. d) 


03500 

0018 


30 

PN(I.d) « PO(I ,d) 


03600 

0019 



IF ( 1 DEBUG. GT . 2 ) MRITE(6.25) ( ( Q ( I . d ) . dml ,«) , I«1 ,8 ) 


03700 

0020 


25 

FORMATISX.'Q MATRIX IN PROP: '/< 1 0X.6E15.8) ) 


03800 



C* *4 



03900 



c 

INITIALIZE STATE TRANSITION MATRIX 


04000 



c» •• 



04100 

0021 



DO 40 Iml ,N ! MAS NS 


04200 

0022 



00 40 dm 1 ,N 1 MAS NS 


04300 

0023 



PHlP(I.d) ■ 0. 


04400 

0024 


40 

PHIP(d.d) • 1. 


04500 

0025 



00 SO I « 1.N 


04600 

0026 



DO 50 d • 1 ,N 


04700 

0027 


50 

0(1. d) • 0. 


04800 



C 



04900 



c 




U o 


PROP 


VAX-11 FORTRAN V2.0-2 
_D8A0: [01 1R.GCP ]PROP. FOR; 9 


P«C» 


6-Apr-1 981 
17-0ct-1 980 


15:00:06 

15:00:16 


050CC 0028 RETURN 

05100 0029 END 


PROGRAM SECTIONS 


Name 

0 SC ODE 

1 SPOATA 

2 S LOCAL 

3 DEBUG 


Bytes 

At tr i butes 







526 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

33 

PIC CON REL 

LCL 

SHR 

NOEXE 

RD 

NOMRT 

LONG 

308 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

MRT 

QUAD 

8 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

HRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00 000000 PROP 

VARIABLES 


Address Type 

Naae 

Address 

Type Naise 


Address 

Type 

Name 

Address 

Type Name 


2-00000080 

1*4 

I 

3-00000004 

1*4 I DEBUG 


3-00000000 

1*4 

I ENTER 

2-000000B4 

1*4 d 


2-00000008 

1*4 

K 

2-0000008C 

I *4 L 


2-OOOOOOCO 

1*4 

M 

A P—00000008# 

I *4 N 


AP-00 0000040 

1*4 

NS 










ARRAYS 












Address Type 

Naw 

Bytes 

0 i mens i ons 








2-00000000 

R*8 

B 

176 

(22) 








AP— 00 OOOOOCO 

R*8 

PHI 

3872 

(22. 22) 








AP-00 0000 ICO 

R*8 

PHIP 

3872 

(22, 22) 








AP- 00 0000 100 

R*8 

PN 

3872 

(22. 22) 








AP-00 0000 140 

R»8 

PO 

3872 

(22. 22) 








AP-00 00001 BO 

R*B 

0 

3872 

(22. 22) 








LABELS 












Address 

Label 

Address Label 

Address 

Label 

Address 

Label 

Address Label 

Address 

Label 

• • 

10 


• • 20 

1-00000000 

2B ' 

• • 

30 


• • 40 

• • 

SO 


Total Space Allocated ■ 075 By tea 
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PROP 


6- Apr- 1 981 15:00:06 
17-Oct-1980 15:00:16 


VAX-11 FORTRAN V2.0-2 
_D6A0:[01 1R.GCP)PROP.FOR:9 


Fag* 3 


COMMAND QUALIFIERS 


FORT ran /LIST GCP, INDATA .MATAB .OUT DATA . RUNG, DNAV .EPHEM.TRUEA.SPRESS, OCCULT .GPERT .GCPSEQ. VISIBLE .GENENV , TREG.GVROUT .RATE ,BHAT .CMA 


/CHECK. (NO BOUNDS .OVERFLOW) 

/debug. ( no symbol s . trac esack ) 

/FT7 /NOG _ float INC /!« /OPTIMIZE /WARNINGS /NOO.LINES /NOMACMlNE_COOE /CONTINUATIONS-1® 


COMPILATION STATISTICS 


Run T<««: 
Elapsed Tin*: 
PRO* Faults: 
Dynamic Memory: 


1 . 99 ttcoiidi 
29.30 scconos 
353 

190 pages 


.2 Compute Measurement Partial* (MPART) 


Sab routine MPART, called by EST, acts as an executive for the com- 
putation of the partial* required by the Carlson Filter routine In 
UPDATE. This routine calls the routines HLMT, HGPS, or HSTAR depending 
upon the measurement to be made. This measurement Is dictated by MCCDE 
an integer flag passed through common. 
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MPART VCLR 



Figure A- 37 
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0001 


SUBROUTINE MPART 


6-Apr-1981 15:00:37 
30-Sep-1980 00:11:26 


VAX-11 FORTRAN V2.0-2 
_DBA0: [01 1 R . GC P i MPART . FOR; 3 


Page 



j: 

1 


! 


1 




J 


I 




00100 
00200 
00300 
00400 
00500 
O'. 300 
00700 
00800 
00900 
01000 
OIIOO 
01200 
0 I 300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 0002 

02500 0003 

> 02500 0004 

l 02500 0005 

C? 02500 
up 02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
0260C 
02700 

U2800 0006 

02900 0007 

03000 
03100 
03200 

03300 0008 

03400 0009 

03500 
03600 
03700 

03800 0010 

03900 0011 

04000 
04100 
04200 

04300 0012 

04400 0013 

04500 


c 

c 

i- 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

o 

c 

c« 


c* 

c 

o 

10 

o 

c 

o 

20 

c» 

c 

c» 

30 

c« 


SUBROUTINE MPART GENERATES THE PARTIAL DERIVATIVES OF 

THE MEASUREMENT WITH RESPECT TO THE ESTIMATED STATE. f 
IT ACTS AS AN EXEC U 1 1 VE CALLING OTHER SUBROUTINES | 
TO PERFORM TH NECESSARY FUNCTIONS. j 


INPUT PARAMET RS 1 

MC0DE = the EVENT CODE DETERMINING THE 1 

MEASUREMENT BEING MADE i 

OUTPUT PARAMETERS 

THE R SPECTIVE PARTIALS FOR THE MEASUREMENT 
BEING MADE THROUGH COMMON 

SUBROUTINES CALLED \ 

HLMT TO COMPUTE THE PARTIALS FOR THE LANDMARK 

TRACKER j 

HGPS to COMPUTE THE PARTIALS FOR THE GPS 

HSTAR TO COMPUTE THE PARTIALS FOR THE KTH 1 

STAR TRACKER 


COMMON BLOCKS 
INCLUDE 1 TARG TS.COM 1 

COMMON /TARGETS/ MT Y PE . 1 S . NS . JFL AG .MCOOE . PI . TPI 
LOGICAL UFLAG 
REAL*8 PI. TPI 


MEASUR MENT SPECIFICATIONS 


MTYPE MEASUREMENT TYPE 

JFLAG SET FOR STAR OBSTRUCTION 

MCOOE * * MEASUREMENT PROCESSING 

PI PI 

TPI 2« PI 


BRANCH TO THE APPROPRIATE MEASUREMENT SUBROUTINE 


GOTO ( 10,20 ,30.40) .MCODE ' 
RETURN 


COMPUTE THE PARTIALS FOR THE LANDMARK TRACKER 


CALL HLMT 
RETURN 


COMPUTE THE PARTIALS FOR THE GPS MEASUREMENTS 


CALL HGPS 
RETURN 


COMPUTE THE PARTIALS FOR STAR TRACKER NUMBER ONE 


CALL HSTAR(1 ) 
RETURN 


tr 










MPART 



6 -Apr - 1 981 

15:00:37 




30 -Sep- 1980 

08 : 1 1 : 26 

04600 


C 

COMPUTE THE PART I A LS FOR STAR TRACKER NUMBER TNO 


04700 


c • ••• 



04800 

0014 

40 

CALL HSTAR(2 ) 


04900 

0015 


RETURN 


05000 

0016 


ENO 



VAX-11 FORTRAN V2.0-2 
_DBAO:[Dt 1R.GCP]MPART.F0R;3 


Fag* 2 


PROGRAM SECTIONS 



Name 

Bytes 

Attr 1 butes 







0 

SC ODE 

59 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOMRT 

LONG 

1 

SPDATA 

B 

PIC CON REL 

LCL 

SHR 

NOEXE 

RO 

NOMRT 

LONG 

2 

SLOCAl 

16 

PIC CON REL 

LCL 

NO SHR 

NOEXE 

RO 

MRT 

LONG 

3 

targets 

36 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RO 

MRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 MPART 


VARIABLES 


Address 

Type 

Nan* 


Address 

Type 

Naas 


Address 

Type 

flint 

Address 

Type 

Name 

3-00000004 

1*4 

IS 


3-OOOOOOOC 

L*4 

JF LAO 


3-00000010 

1*4 

MCODE 

3-00000000 

1*4 

MTYPE 

3-00000008 

1*4 

NS 


3-00000014 

R*B 

PI 


3-00 00001C 

R*B 

TPI 




LABELS 














Address 

Labe 1 


Address 

Label 

Address 

Labs! 

Address 

Label 





0-0000001 A 

10 


0-00000022 

20 

0-000000 2A 

30 

0-00000032 

40 






FUNCTIONS ANO SUBROUTINES REFERENCED 
MGPS HLMT HSTAR 


Total Space Allocated « 119 Bytes 


CONMANO QUALIFIERS 

FORTRAN /LIST GC P.INOATA. MAT AB. OUT OATA. RUNG, DNAV , EPHEN, TRUEA , SPRESS , OCCULT, GPERT , GCPSEQ . VISIBLE, GENENV.TREG.GYROUT, RAT E.BMAT.CMA 

/CHECK* ( NO BOUNDS .OVERFLOW) 

/DEBUG* ( NO SYMBOL S . TRAC EBACK ) 

/F77 /NOG FLOATING /I4 /OPTIMIZE /WARNINGS /NOD.LINES /NOMACHINE.COOE /CONT INUATIONS-19 




1 


6-Apr-1981 15:00:37 VAX-11 FORTRAN V2.0-2 
30-S«p-1980 08=11:26 _DBA0 : [ D 1 1 R . GC P JMPART . FOR ; 3 


COMPILATION statistics 


Run Tim*: 
Elapsed Tima: 
Page Fault a: 
Dynamic Memory: 


0. 79 seconds 
15.32 seconds 
301 

180 pages 


> 

1 

. j 


irtaimtttgi "i '1 • 


Page 2 




2. 7.2.1 Compute GPS Measurement Partials (HGPS) 

HGPS, Called by MPART, computes the sensitivity of the GPS measurements to 
variations in the elements of the estimated state. This routine doesn't 
require the support of any major routine. 

Processing Requirements 

The GPS measurement vector is given by 

zg -|*, a, i, i] T 

The sensitivity of this measurement vector to estimated state elements 
given by 

H* * 1 for *, y, t, 4, I 
■ 0 otherwise 


HGPS VCLR 


SET UP ESTIMATED MEASUREMENT 
VECTOR 


ZERO ARRAYS 


CONVERT TO RAW-VECTOR FORM 


Figure A-38 
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6-Apr-19B1 15:03:00 
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VAX-11 FORTRAN V?. 0-2 
_OBAO: [Dl 1 R . CC 1 )HGPS. FOR :4 


Page 


00100 

0001 



subroutine HGPS 

00200 



C' • 


00300 



C 


00400 



c 

subroutine HOPS generates the specific partials 

00500 



c 

RELATING TO THE GLOBAL POSITIONING SYSTEM MEASUREMENTS. 

00600 



c 


00700 



c 

INPUT PARAMET RS 

ooeoo 



c 

NONE 

00900 



c 

OUTPUT PARAMETERS 

01000 



c 

PX = X POSITION MEASUREMENT PARTIALS 

01 100 



c 

PY * Y • 

01200 



c 

PZ = z • 

01300 



c 

PXO = X VELOCITY • 

01400 



c 

PYD = T • 

01500 



c 

PZO « i. • 

01600 



c 


01700 



c • * 


01600 



c 


01900 



c 

COMMON BLOCKS 

02000 

0002 



INCLUOE 'PART.COM' 

02100 

0003 

• 


COMMON /PART/ PX ( 2 2 ) . PY ( 22 ) , PZ ( 22 ) , PXD( 22 ) , PYD( 2 2 ) . PZO l 22 ) , 

02100 


• 


. PDMS ( 22 t 2 J . PDVS( 22.2) . PDHL< 22 ) . POV L< 22 ) 

02100 

0004 

• 


REAL'S PX . PY , PZ . PX 0 , PYO . PZO . PDHS . POVS , PDHL . PDVL 

02100 


• 

c 


02100 


• 

c 

PARTIALS OF THE RESPECTIVE MEASUREMENTS MAOE 

02100 


• 

c 


02100 


• 

c 

FOR GPS 

02100 


• 

c 

PX C PARTIALS of X POSITION MEASUREMENT 

02100 


• 

c 

p Y . . . Y . 

02100 


• 

c 

PZ * • ■ z 

02100 


• 

c 

PXO * * X VELOCITY 

02100 


• 

c 

PYO i ■ • Y * * 

02100 


• 

c 

PZO » • • Z * • 

02100 


• 

c 

FOR STAR TRACKER K (K is THE SECOND PARAMETER) 

02100 


• 

c 

PDHS * PARTIALS OF HORIZONTAL OIFLECTION 

02100 


• 

c 

POVS - ’ * VERTICAL 

02100 


• 

c 

FOR LANDMARK TRACKER 

02100 


0 

c 

POHL = PARTIALS OF HORIZONTAL OIFLECTION 

02100 


0 

c 

POVL * * ■ VERTICAL. 

02100 


• 

c 


02100 

0005 



INCLUOE 'NSTATE.COM' 

02200 


* 

c 


02200 

0006 

* 


COMMON /NSTATE / XD< 6 ) . X ( 6 ) . RAOM . RADE 

02200 

0007 

* 


REAL'S XO.X. RAOM. RADE 

02200 


• 

c 


02200 


• 

c 

POSITION STATE AND CONSIDERED PARAMETERS 

02200 


• 

c 


02200 


• 

c 

XD STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 

02200 


• 

c 

X STATE POSITION PARAMETERS (KM AND KM/SEC) 

02200 


• 

c 

RADM RADIUS OF THE MOON (KM) 

02200 


• 

c 

RADE EARTH DETECTABLE RADIUS (KM) 

02200 


0 

c 


02200 


0 

c 


02200 

0008 



INCLUDE 'MEAS0UT.COM' 

00100 

0009 

0 


COMMON /MEASOUT/ MX ( 6 ) . RGPS( 6 . 6 ) , DHCS ( 2) , D VCS( 2 ) , MS( 3 . 2 ) , 

00200 


0 


. RS(2 ,2.2) . OHCL.DVCL, LMU(3) ,RL(2,2) , EMXG( 6) . 

00300 


0 


. EDHS (2) , ED VS( 2 ) , EDHLiEOVL 


* 


HGPS 


00400 

00500 

00600 

00700 

ooeoo 

00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01 BOO 
01900 
02000 
02100 
02200 
02300 
02400 
02500 
02600 
02700 
02800 
02900 
03000 
03100 
03200 
03300 
03400 
03500 
03600 
03700 


6-Apr- 19B1 15:03:00 
9-Feb-l 981 17:54:54 


0010 


REAL'S MX.RGPS.DHCb ,DVCS .MS . RS , DHCL . OVCL , LMU , RL . EMXG . 
EDHS , -OVS . EDHL . E OV L 


MEASUREMENT 

MX 

EMXG 

RGPS 

DMCS 

DVCS 

EDHS 

EDVS 

MS 

RS 

DHCL 

DVCL 

EDHL 

EDVL 

LMU 

RL 


- GPS 


OUTPUT PARAMETERS 

« POSITION/VELOCITV STATE MEASUREMENT 
(KM. KM /SEC) 

• ESTIMATED POSITION/VELOCITY STATE 
MEASUREMENT - HGPS 

« STATE MEASUREMENT NOISE COVARIANCE 

( KNO-. L EDGE ) - GPS ( KM* * 2 . KM/ SEC* *2 ) 

• STAR MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - START (RAD) 

= STAR MEASUREMENT VERTICAL DEVIATION 
FROM BORESIGHT - START (RAD) 

» ESTIMATED STAR MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RAD) 

« ESTIMATED STAR MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 

« STAR MEASUREMENT UNIT VECTOR (SECOND 

SUBSCRIPT REFERS TO TRACKER) - START 

• STAR MEASUREMENT NOISE COVARIANCE 
(KNOWLEDGE) - START (RA0--2) 

. LANDMARK MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - LAMKT (RAD) 

• LANDMARK MEASUREMENT VERTICAL DEVIATION 
FROM BORESIGHT - LAMKT (RAD) 

- ESTIMATED LANOMARK MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RAD) 

• ESTIMATED LANOMARK MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 

• LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

• LANDMARK MEASUREMENT NOISE COVARIANCE 
(KNOWLEDGE) - LAMKT (RAD--2) 


03800 


• 

c 


02300 

001 1 



DIMENSION HG (6,10) 

02400 

0012 



REAL*8 HG 

02500 



c 


02600 



c * ••• 


02700 



c 

SET UP ESTIMATED MEASUREMENT VECTOR 

02800 



c* *** 


02900 

0013 



DO 5 1-1.6 

03000 

0014 


5 

EMXG( I )«X( I ) 

03100 



c 


03200 



c* 


03300 



c 

ZERO ARRAYS 

03400 



c* ••• 


03500 



c 


03600 

0015 



DO 10 1-1 .6 

03700 

0016 



DO 10 J»1 , 10 

03800 

0017 


10 

HG( I , J ) -0. 

03900 



c 


04000 



0 •** 


04100 



c 

SET UP PARTI ALS IN MATRIX FORM 

04200 



c * •+« 



04300 

04400 


0018 


VAX-11 FORTRAN V2.0-2 
_OBAO: ( D 1 1R.GCP ]HGPS . FOR: 4 


P»0* 


DO 20 1-1.6 


6-Apr-19P1 15:03100 VAX-11 FORTIN V2.0-2 

9 -Feb- 1 981 17:54:54 _DBAO:[D11K.GCP]HGPS.FOR:4 


04500 

0019 

20 

HG( I . I ) *1 • 

04600 


C 


04700 


C* • •• 

CONVERT TO ROW VECTOR FORM 

04800 


c 

04900 


c • ••• 


05000 

05100 

0020 

c 

OO 30 1-1.10 

05200 

0021 


PX( I l*HG( 1,1) 

05300 

0022 


PY(I)*HG(2.I) 

05400 

0023 


PZ< I l«HG(3,I ) 

05500 

0024 


PXD( I ) =HG(4, l ) 

05600 

0025 


PYD< I ) =HG( 5 , I ) 

05700 

0026 

30 

PZD( I ) =HG(6. I ) 

05800 

0027 


DO 40 I«11 .22 

05900 

0028 


PX( 1 )*0. 

06000 

0029 


PY( I )«0. 

06100 

0030 


PZ( I )«0. 

06200 

0031 


PXO( I > >0. 

06300 

0032 


PYD( I ) »0. 

06400 

0033 

40 

PZO(I)-0. 

06500 

0034 


RETURN 

06600 

0035 


END 


PROGRAM SECTIONS 


Name 

0 SCODE 

2 (LOCAL 

3 PART 

4 NSTATE 

5 MEASOUT 


Bytes 

Attr ibutee 

190 

PIC 

CON 

REL 

488 

PIC 

CON 

REL 

21 12 

PIC 

OVR 

REL 

112 

PIC 

OVR 

REL 

648 

PIC 

OVR 

REL 


LCL 

SHR 

EXE 

RO 

NOWRT 

LONG 

LCL 

NOSHR 

NOEXE 

RO 

NRT 

QUAD 

GBL 

SHR 

NOEXE 

RD 

WRT 

LC.NG 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

GBL 

SHR 

NOEXE 

RD 

WRT 

LCNG 


ENTRY POINTS 

Address Type Name 
0-00000000 HOPS 


VARIABLES 


Address 

Typ« 

Nam* 

5 - 000001 EO 

R*8 

OHCL 

2-000001 EO 

1*4 

I 


Address 

5-000001E8 
2-00000 1 E4 


Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

R»8 

1*4 

OVCL 

J 

5-00000278 

4-00000068 

R*8 

R*8 

EOHL 

RADE 

5-00000280 

4-00000060 

R*8 

R*8 

EDVL 

RA DM 


P«0* 


A-240 


VAX-11 FORTRAN V2.0-2 
_0BA0:[011R.GCP]HCPS.FOR;4 


Fag* 4 


HjPS 


6 -Apr- 1 981 
»-Feb-198l 


15:03:00 

17:54:54 


ARRAYS 


Address 

Type 

Name 

Bytes 

Dimensions 

5-00000150 

R«8 

DHCS 

16 

m 

5-00000160 

R*8 

DVCS 

16 

(2) 

5-00000258 

R«8 

EDHS 

16 

(2) 

5-00000268 

R»8 

EDVS 

16 

(2) 

5-00000228 

R*8 

EMXG 

48 

(6) 

2-00000000 

R«8 

HG 

480 

(6. 10) 

5-000001 FO 

R*8 

LMU 

24 

(3) 

5-00000170 

R*B 

MS 

48 

(3. 2) 

5-00000000 

R*8 

MX 

48 

(6) 

3-00 0006E0 

R*8 

POHL 

1 76 

(22) 

3-00000420 

R*B 

PDHS 

352 

(22. 2) 

3-00000790 

R*8 

PDVL 

1 76 

(22) 

3-00000580 

R*8 

PDVS 

352 

(22. 2) 

3-00000000 

R*8 

PX 

176 

(22) 

3-00000210 

R*8 

PXD 

1 76 

(22) 

3-OOOOOOBO 

R*8 

PY 

1 76 

(22) 

3-000002CO 

R*8 

PYD 

176 

(22) 

3-00000160 

R*B 

PZ 

1 76 

(22) 

3-00000370 

R*B 

PZD 

176 

(22) 

5-00 000030 

R*8 

RGPS 

288 

(6. 6) 

5-00000208 

R*8 

RL 

32 

(2. 2) 

5-00 CO0 1 AO 

R*B 

RS 

64 

(2. 2. 2) 

4-00000030 

R*8 

X 

48 

(6) 

4-00000000 

R*8 

XD 

48 

(6) 


LABELS 


Address 

Labe 1 

Address 

Label 

Address 

Label 

Address 

Label 

Address 

Label 


5 

ee 

10 

»+ 

20 

*>» 

30 

• * 

40 


Total Space Allocated * 3550 Bytes 


COMMAND QUALIFIERS 

FORTRAN /LIST CCP, INDATA.MAT AB, OUT DAT A, RUNG, DNAV.EPHEN.TRUEA.SPRESS, OCCULT .GPERT , GCPSEQ , VISIBLE .GENENV , TREG .GYROUT , RAT E . BMAT , CMA 
/CHECK. (NO BOUNDS .OVERFLOW) 

/DEBUG. ( NOSYMBOL S , TRACEBACK ) 

/F77 /NOG.FLOAT ING /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE .CODE /CONT INUATIONS-1B 


COMPILATION STATISTICS 


Run Time: 
Elapsed Tima: 
Page Fau Its: 
Dynamic Memory: 


1 . 42 seconds 
16.58 seconds 
321 

160 pages 


e 


2. 7. 2. 2 COMPUTE LANDMARK TRACKER MEASUREMENT PARTIALS (HLMT) 

HLMT, calle* by MPART, computes the eeneitivity of the landmark tracker 
measurement vector sensitivity to the individual element* of the estimated 
PMRAS vector * Thl# 1S don * with th * »upport of subroutine SPETB1, SP1MI, and 


Processing Requirements 

A measurement vector from the spacecraft to the landmark is developed by 
subtracting the estimated spacecraft position ( p ) vector from the lankmark 
position vector(L) . The resulting measurement vector is transformed to 
landmark tracker coordinates ( Mi) and converted to a unit vector (Ofc)* The 
partial* of this unit vector with respect to the estimated state vector 
elements are given by. 

aU£ ^ |Mg 1 3j£ ± g* 9^ 

|M£. | 2 

where the terms of the equation are computed by 

M£ | - (faTftg) 5 * 

} [l^ {q ij }( ^ ‘ ^ (L - £)] . i - 1,2, . . .,10 

0 otherwise 

( M« T ^ M£)|M£| _1 , i - 1, 2, .... 10 
*= 0 otherwise 



9M£ 

3xj 


where 

Mi ■ the estimated measurement vector in landmark tracker 
coordinates 

( a ij) “ transformation from body to landmark tracker coordinates 
(lij) m transformation from inertial body coordinates, 

- " Spacecraft estimated position vector in inertial coordinates 

L ■ landmark position vector in inertial coordinates, 

xj ■ estimated itb estimation state vector element. 


A-241 


HLMT VCLR 


>• ; 

f ' 

r 


Coinput* LM position vector- inertial apace 


Compute estimated measurement-inertial space 


Transform estimated measurement to LMT coordinates 


Convert estimated measurement to unit vector 


Compute partial of estimated inertial to body transformation 
WKT estimated state (SPETBI) 


Compute partial of estimated measurement vector in inertial 
space WRT estimated state (SPEMI) 


Compute partial of estimated measurement vector in LMT 
coordinates WRD estimated state 


Compute partial of magnitude estimated measurement in LMT 
coordinates WRD estimated state 


Compute partial of estimated unit vector in LMT coordinates 
WRT estimated state 


Convert unit vector partlals to measurement partlals 
(PMEAS) 


Compute measurement partlals for states 1 through 10 


Fill all other measurement partial elements (11 through 22) 
with 0 
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VAX-11 FORTRAN V2.0-2 
_D8A0: [01 1R.GCPJHLMT . FOR 


00100 

0001 


subroutine hlmt 


00200 


c» •••••« 



00300 


c 



00400 


c 

SUBROUTINE HLMT COMPUTES the PARTIAIS OF THE LAN QUARK 

00500 


c 

tracker MEASUREMENT VECTOR with respect to the estimated 

00600 


c 

state vector . 


00700 


c 



00800 


c 

INPUT paramet.rs 


00900 


c 

RE 

average RADIUS OF THE EARTH 

01000 


c 

AL * 

ALTITUDE OF THE LANDMARK ABOVE RE 

01100 


c 

LON 

LONGITUDE OF THE LANDMARK 

01200 


c 

LAT 

LATITUDE " 

01300 


c 

T 

PRESENT TIME 

01400 


c 

TO 

initial time 

01500 


c 

TIED 

INITIAL EARTH FIXEO TO INERTIAL 

01600 


c 


TRANSFORMATION 

01700 


c 

TBNL 

LANDMARK TRACKER TRANSFORMATION FROM 

01800 


c 


NOMINAL TO B08Y 

01900 


c 

TNLK 

KNOWLEDGE TRANSFORMATION FROM LANDMARK 

02000 


c 


TRACKER TO NOMINAL (MISALIGNMENT 

02100 


c 


ARRAY ) 

02200 


c 

E 

ESTIMATED QUATERNIAN ARRAY 

02300 


c 

P * 

ESUMATEO POSITION VECTOR IN INERTIAL 

02400 


c 


SPACE 

02500 


c 

OUTPUT PARAMETERS 


02600 


c 

POHL * 

PART I A LS OF HORIZONTAL DIFLECTICN 

02700 


c 

POVL * 

• * VERTICAL 

02800 


c 



02900 


€•••••• 



03000 


c 



03100 


c 

COMMON BLOCKS 


032 00 

0002 


INCLUDE 'TIME.COM 


00100 


« c 



00200 

0003 

• COMMON /TIME/ T IME . TNELT . TSTOP . T 1 A.DEL , T IN, DTN.DAT EO , TZERO 

00300 


♦ 

.TMEAS ■ TRACK , TIS. T 1 SN, DT A , DATER , TPR I NT ,DTRR INT 

00400 

0004 

* REAL*B TIME, TNEXT.TSTOP.TIA, DEL. TIN.DTN.DATEO.TMEAS. TRACK, TIS, 

00500 



TISN.DTA.TZERO.DATER.TPRINT.DTPRINT 

00600 


• C 



00700 


• C 

THESE ARE THE TIME REFERENCE FRAMES 

00800 


• C 



00900 


• C 

TIME 

ATOMIC TIME SINCE TN I T I ALI ZAT ION (SEC) 

01000 


• c 

TNEXT 

TIME FOR NEXT POSITION INTEGRATION (SEC) 

01100 


• c 

TSTOP 

RUN TERMINATION TIME (SEC) 

01200 


• c 

TIA 

ATTITUDE INTEGRATION TIME (SEC) 

0 1 ‘.00 


• c 

0 L 

- ■ STEP SIZE (SEC) 

01400 


• c 

TIN 

POSITION INTEGRATION TIME (SEC) 

0 1 5C0 


• c 

OTN 

• • STEP SIZE (SEC) 

0160V 


• c 

DATEO 

OATE OF FLIGHT EPOCH (JO) 

01700 


• c 

DATER 

DATE OF 1950 EPOCH (JD) 

01800 


• c 

TZERO 

START TIME IN SECS. SINCE DATEO 

01900 


• c 

TSLEN 

TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

02000 


• c 

TIS 

REAL WORLD REFERENCE TIME (SEC) 

02100 


• c 

TISN 

TIME FOR NEXT RM POSITION INTEGRATION (SEC) 

02200 


• c 

OTA 

USUALLY 4 DEL BUT ♦ TSLEW - TIA WHEN DEL 

02300 


• c 


TOO LARGE AT MEASUREMENT TIME 

02400 


• c 

TPRINT TIME FOR PRINT (SEC) 

02500 


• c 

DTPRINT INCREMENT ON TPRINT (SEC) 


hunt 


6- Apr-1981 15:00:53 VAX-11 FORTRAN V2.0-2 
•-Fvb-1981 17:5»:S3 _DBAO: [D 1 1 R.GCP 1MLMT . FOR : 26 


> 

I 

NJ 

i> 


03600 

• C 

03300 

0005 

03400 

• C 

03400 

0008 • 

03400 

0007 • 

03400 

• C 

03400 

• C 

03400 

♦ C 

03400 

• C 

03400 

• C 

03400 

• C 

l 1400 

• C 

03400 

• c 

03400 

• c 

03400 

• C 

03400 

0008 

03500 

• C 

03500 

0009 • 

03500 

0010 • 

03500 

• C 

03500 

• C 

03500 

• c 

03500 

• c 

03500 

• c 

03500 

• c 

03500 

• c 

03500 

• c 

03500 

• c 

03500 

0011 

00100 

0012 • 

00200 

• 

00300 

0013 • 

00400 

• 

00500 

• c 

00600 

♦ c 

00700 

• C 

OCBOO 

• c 

00900 

• C 

01000 

• c 

01 100 

• c 

01200 

• C 

01300 

* c 

01400 

• C 

01500 

• C 

01600 

• C 

01 TOO 

• c 

01 BOO 

• C 

01900 

• C 

02000 

• c 

02100 

• c 

02200 

• c 

02300 

• c 

02400 

• c 

02500 

• c 

03604 

0014 

03700 

0015 • 

03700 

• 


INCLUDE ' AST ATE . CON 1 

COMMON /ASTATE/ OE ( 4 ) . E ( 4 ) . KOI 3 ) . SF( 3 ) . D( 3) . 0O< 3) 
REAL'S DE.E.WD.SF.0.00 

ATTITUDE STATE AnO CONSIDERED PARAMETERS 


0 D1FERENTIAL OF QUATERNIONS 

E QUATERNIONS 

WO GYRO DRIFT RATE <RAD/SEC) 

SF GYRO SCALE FACTOR 

D GYRO NON-ORTHOGANAL1TY (RAO) 

DO GYRO RELATIVE ORIENTATION (RAO) 

INCLUDE * NST ATE . COM ' 

COMMON /NSTATE / XO< 6 ) . *( 6 ) , RADM . RADE 
REAL'S XO.X.RAOM.RAOE 

POSITION STATE AND CONSIOEREO PARAMETERS 

XO STATE DERIVATIVES (KM/SEC ANO KM/SEC/SEC) 

X STATE POSITION PARAMETERS (KM AND KM/SEC) 

RADM RADIUS OF THE MOON (KM) 

RAOE EARTH OETECTABLE RADIUS (KM) 


INCLUDE ' LMT PAR . COM ' . 

COMMON / LMT PAR/ AL . LON , L AT . TBN L( 3, 3 ) . TNL( 3 . 3 ) , BL ( 2 ) , SL ( 2 ) . 
. BKL(2).SKL(2).TNkKj3«3).TtE0(3,3), 51GGCP , THCT 

REAL'S AL.TSNL.TNL.BL.SL .BKL.SKL, TNLK, TIES .SIGGCP.LAT . LON. 
. THET 


LANDMARK TRACKER PARAMETERS 

AL « ALTITUDE OF LANDMARK (KM) 

LON ■ LONGITUDE OF LANOMARK (DEG) 

LAT « LATITUDE OF LANDMARK (DEG) 

T6NL « ORIENTATION ARRAY FOR LANOMARK TRACKER 
NOMINAL TO ROOT 

TNL « MISALIGNMENT ARRAY - ACTUAL 

TRACKER TO NOMINAL 
BL ■ BIAS - ACTUAL (RAD) 

SL • NOISE STANDARD DEVIATION - ACTUAL ( RAD) 

BKL • BIAS - KNOWLEDGE (RAO) 

TMET « LOOK ANGLE (RAO) 

SKL • NOISE STANOARO DEVIATION -KNOWLEDGE (RAO) 

TIEO ■ INITIAL EARTH FIXED TO INERTIAL 
TRANSFORMATION 

TNLK • MISALIGNMENT ARRAY KNOWLEDGE 

TRACKER TO NOMINAL 

SIGOCP « POSITION UNCERTAINTY OUE TO CLOUDS 
INCLUDE 'PART.COM' 

COMMON /PART/ PX(22),PY(22).PZ(22).PXD(22), PVD( 22) .PZO( 22) • 
POMS (22. 2) , POVSl 22.2). P0HL(22) ,PDVL(22 ) 


MLMT 


03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
03700 
037C0 
03700 
03700 
03700 
03700 
03700 
03800 
03800 
03600 
03800 
03600 
, 03600 

03600 
: 03800 

r 03800 
03800 


0018 • 


C 

• C 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 


0017 

0018 

0019 

0020 


03800 

03800 

03800 

0021 

00100 

0022 

00200 

00300 

00600 

00500 

00600 

00700 

03900 

0023 

00100 

0024 

00200 

00300 

00600 

0025 

00500 

00600 

00700 



00800 

00900 

01000 

01100 

01200 

01300 

01600 

01500 

01600 

01700 


6- Aor - 1 981 15:00:53 
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VAX-11 FORTRAN V2.0-2 
_OBA0:lO11B.0CP]ML«»T.FO»:26 


«AL.0 PX.PY.PZ.P* 0.F70.«D.WM*.W»S.Wt.Wl 

part t a us OF me respective measurements made 
FOR CPS 

T 

z 

X VELOCITY 
Y 

z 

SECOND PAR 


PX 

a 

PY 

a 

PZ 

a 

PXO 

a 

PYD 

a 

PZO 

a 

FOR STAR TRACXER X 


FOR LANOMARX TRACXER 
POML - D * 
PDVL 


C 

c 
c 
c 
c 
c 
■ c 

: C 

- c 


• c 

• c 

• c 

• c 

• c 

• c 


• 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 


INCLUDE 'TARO TS ' C °“',_ .c, AC MC00C.PI.TP1 

COMMON /TARGETS/ NT Y PE . IS . NS . JFL AG.MCOU* . 

logical jflag 

REAL*0 Pl.TPI 

MEASUR MENT SPEC 1 F ICAT lOWi 

measurement type 
SET FOR STAR OtSSTRUCI 10* 

• • MEASUREMENT PROCESSING 

PI 

2»Pl 


MTYPE 
JF LAG 
MCOOE 
PI 
TPl 


INCLUOE •OE0UG.COM' 

COMMON /DEBUG/ 1ENTER . 1DEBUG 

..aiucrfal TO VARY DEBUG PRINT LEVEL 
USER CONTROLLED PARAMETERS TO 

!r , prints mmen enters most SUBROUTINES 
V-iol mGHER NUMBER MEANS MORE PRINT 


I NTER 
I DEBUG 


INCLUOE 1 MCA SUUT . COM * . qhc S< 2 ) . DVCS l 2 } , MS < 3 . 2 ) . 

EOMS.-DVS.EOML.EOVi 


EASUREMENT OUTPUT PARAMETERS 


EMXG 

RGPS 

OHCS 

DVCS 


POSI^Ton/ VELOCITY STATE MEASUREMENT - GPS 

. ESTIMAUO’POSITION/VELOCITY STATE 

MFA^LinEKCNT * HGPS 

■ i -‘ ,t 53 K 5 E ?iS IrSsSSS”" 

■ «- 

. STAR MEASUREMENT VERTICAL DEVIATION 


> 

I 

> o 
4> 
S' 


hlmt 




01 BOO 


• 

C 

01900 


• 

C 

02000 


• 

c 

02100 


• 

C 

02200 


• 

c 

02300 


• 

C 

02400 


• 

c 

02500 


• 

c 

02600 


• 

c 

02700 


• 

c 

02800 


• 

c 

02900 


* 

c 

03000 


• 

c 

03100 


• 

c 

03200 


• 

c 

03300 


• 

c 

03400 


• 

c 

03500 


• 

c 

03600 


• 

c 

03700 


• 

c 

03B00 


• 

c 

04000 

002* 



04100 

0027 



04200 




04300 




04400 

0028 



04500 




04600 




04700 



c* 

04800 



c 

04900 



c 

05000 



c< 

05100 




05200 

0029 



05300 

0036 



05400 

0031 



05500 



c* 

05B00 



c 

05700 



c 

05800 



c* 

C5900 

0032 



OGOOO 



c« 

06100 



c 

06200 



c« 

06300 

0033 



06400 



c* 

06500 



c 

06600 



c 

06700 



c* 

OBBOO 

0034 



06900 

0035 



07000 



c« 

07100 



c 

07200 



c« 

07300 

0035 



07400 



c* 

07500 



c 


6-ACW-19S1 15-00:53 
9- Feb- 1901 17:59:53 


COHS 

edvs 

MS 

RS 

ONCL 

DVCL 

edml 

EDVL 

LMU 

RL 


FROM BORESIGHT - START (RAD) 

• ESTIMATED ^TAR MEASUREMENT HORIZONTAL 

DEVIATION FROM BORESICHT (RAD) 

• ESTIMATED star measurement vertical 

DEVIATION FROM BORESIGHT I RAD) 

• STAR MEASUREMENT UNIT VECTOR (SECOND 

SUBSCRIPT REFERS TO TRACKER) - START 

• STAR MEASUREMENT NOISE COVARIANCE 

(KNOWLEDGE) - START (RAD* -2) 

• LANDMARK MEASUREMENT HORIZONTAL DEVIATION 

FROM CORESIGHT - LAMkT (RADI 

• LANDMARK MEASUREMENT VERTICAL OtVIATION 

FROM BORCSIGHT - LAMKT (RAD) 

• ESTIMATED LANDMARK MEASUREMENT HORIZONTAL 

DEVIATION FROM BORESIGHT (RAD) 

• ESTIMATED LANDMARK MEASUREMENT VERTICAL 

OEVIATION FROM BORESIGHT (RAD) 

• LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

< landmark measurement noise covariance 

(KNOWLEDGE) - LAMKT (RAO**2) 


EQUIVALENCE ( RE . RAOE ) . ( T . T IME ) , ( EP . X ) 

DIMENSION LEO).'. I El 3.3). L( 3) . ETBH 3 . 3) . ET LB( 3 . 3 ) . ETBI ( 3. 3) . 
. EMI( 3I.EUI (3.3) ,EML<3) .RETBM3.3) . PEMI ( 3 ) , EP( 3 ) . 

. DM3( 3) .DM1 (3) .PEMBO) . PEMLI 3 ) . PEUL ( 3 ) . EU L( 3 ) 

REAL*B MEML.PMEML. TO, DM) , DM2 . EMI .EML , ETBI . ETBL . E T LB. ET L I . 

. EUL.L.LE.PEMB.PEML.PETBI .PEUL. TIE. T.EP. PEMI. VMAG, 

RE 


COMPUTE LE - LANDMARK POSITION VECTOR IN EARTH FIXED 
COORDINATES 


LE1 1 )• I RE*AL ) »COS ( LON* PI /I BO. ) *COS( LAT*PI / 1 80 . ) 
LE(2)«(RE+AL)»SIN( LON* PI / 180. ) *COS(LAT*P!/ 180. ) 
LE(3)«(RE«AL)»S!N< LAT-PI/180. ) 


COMPUTE TIE - EXACT TRANSFORMATION FROM EARTH FIXED TO 

inertial space 


CALL MET(TIEO.TIE) 


COMPUTE L - LANDMARK POSITION IN INERTIAL SPACE 


CALL MATABITI LE.L.3.3.1) 


COMPUTE ETLB - ESTIMATED BOOT TO LANDMARK TRACKER 
TRANSFORMATION 


CALL MATABI TBNL. TNLK.ETBL.3.3. 3) 

CALL M1NV3IETBL.ETLB) 

COMPUTE ETBI - ESTIMATED INERTIAL TO BOOT TRANSFORMATION 


CALL AMAT ( E , ETBI ) 


compute EMI > estimate: MEASUREMENT IN INERTIAL SPACE 


VAX-11 F j.'*TRAN V2.0-2 
_DBA0:(D11A GCPJHLMT .FOR; 26 


pro* a 


HLMT 


6-Apr-l 981 15:00:53 
9-Feb-1 981 17:59:53 


VAX-11 FORTRAN V2.0-2 
_DBAO: [D1 1R.GCP]HLMT.FOR;26 


07600 


C» 

07700 

0037 


07800 

0038 

10 

07900 


C« 

08000 


C 

08100 


c* 

00200 

0039 


0B300 

0040 


08400 


C* 

08500 


c 

08600 


c* 

08700 

0041 


oeooo 


c» 

08900 


c 

09000 


c 

09100 


c* 

09200 

0042 


09300 

0043 


09400 

0044 


09500 

0045 


09600 

0046 


09700 

0047 


09800 

0048 

12 

09900 

0049 


10000 

OOSO 

13 

10100 

0051 

15 

10200 


C* < 

10300 


c 

10400 


c* < 

10500 

0052 


10600 


c*< 

10700 


c 

10800 


c* « 

10900 

0053 


11000 


c* 1 

11100 


c 

11200 


c* « 

11300 

0054 


11400 


c*« 

11500 


c 

11600 


c*« 

11700 

0055 


11800 

0056 


1 ’900 

0057 


12000 

0058 

20 

12100 

0059 


12200 


c«* 

12300 


c 

12400 


c* • 

12500 

0060 


12000 

0061 


12700 

0062 

30 

12800 


C« * 

12900 


c 

13000 


c** 

13100 

0063 


13200 

0064 

40 


DO 10 I » 1 , 3 

EM! ( I) =L(I )-EP( I ) 

****** ****** ****••*********♦«•#*•••****»* 
TRANSFORM TO LANOMARK TRACKER COORDINATES 
****** ****** * * * * • * * + * + + 0 + + + + + I 
CALL MATA3( ETLB. ETBI ,ETL I ,3,3,3) 

CALI MATAB( ETLI , EMI , EML, 3,3, 1 ) 


COMPUTE MEML - MAGNITUDE OF EML 


MEML=VMAG(EML,3) 


COMPUTE EUL - ESTIMATED UNIT VECTOR ALONG ESTIMATED 
MEASUREMENT VECTOR 


CALL UNIT(EML,EUL. 3) 

EOVL=ASIN(EUL( 1 ) ) 

E0HL = ASIN(EUL(2)/C0S( EDV L ) ) 

I F ( I OE BUG .LT. 4>G0 TO 15 
WRITE! 6,42) 

WRIT E ( 6 , 1 2 ) 

FORMAT (' ETBI') 

WRITE! 6, 13) { ( TBI( I ,J) . J*1 ,3) , 1-1,3) 
FORMAT ( 10X.3E17.7) 

CONTINUE 


COMPUTE MEASUREMENT PART I ALS 


DO 100 J.1,10 


COMPUTE PARTIAL OF ETBI WRT ESTIMATED STATE 


CALL SPETBK J.PETBI ) 


COMPUTE PEMI - PARTIAL OF EMI 


CALL SPEMI ( J . PEMI ) 


COMPUTE PEML - PARTIAL OF EML 


CALL MATAB(ETBI,PEMI , DM2 , 3 , 3 , 1 ) 
CALL MATABIPETBI , EMI ,DM1 , 3,3. 1 ) 
DO 20 1.1 ,3 
PEMB( I ) .DM1 ( I )+DM2( I ) 

CALL MATABIETLB. PEMB, PEML, 3,3, 1 ) 


COMPUTE PMEML - PARTIAL OF MAGNITUDE OF EML 


PMEML . 0 . 

DO 30 1*1,3 

PMEML. PMEML+( PEML! I ) *EML ( I l/MEML) 


COMPUTE PEUL - PARTIAL OF ESTIMATED UNIT VECTOR 


DC 40 1*1,3 

P)IUL( I )*(MEML*PEML ( I )-PMEML*EML( X) )/(MEML**2) 


tew?" 


HLMT 


1 3300 

0065 

13400 

0066 

13500 

0067 

13600 

0068 

13700 

0069 

13800 

0070 

13900 

0071 

14000 

0072 

14100 

0073 

14300 

0074 

14300 

0075 

14400 

0076 

14500 


14600 


14700 


14800 

0077 

14900 

0078 

15000 

0079 

15100 

0080 

15200 

0081 

15300 

0082 




6-*pf - 1981 15 : 00:53 VAX -11 fortran V 2 . 0-2 
9-F*b-1981 17:59:53 _DBAO: [ D 1 1R.GCP ]HLMT . FOR :26 


I F( I OEBl'G . LT. 4) GO TO 50 
WRI TE* 6,42) 


42 

FORMAT ( • FROM HLMT ' ) 



WRITE* 6,43) 

J 


43 

FORMAT ( ' 

d = ' . 13) 



WRITE* 6,44) 

M ML. ( PEML* I ) , 1*1 

. 3) 

44 

FORMAT ( 1 

MEML . PEML* I ) 

' , 4( 5X , E 1 5 . 7 ) ) 


WRi TE* 6,45) 

PMEML. (EML( I ) ,1*1 

.3) 

45 

FORMAT ( 1 

PMEML.EML(I) 

1 ,4(5X,E15.,7) ) 


WRITE* 6,46) 

( PEUL { I ) , 1 = 1 ,3) 


46 

FORMAT ( 1 

PEUL* I ) 

' ,20X,3(5X,E15.7) ) 

50 

CONTINUE 



c 

c* **•< 

CONVERT UNIT 

VECTOR PART I ALS 

TO MEASUREMENT PART I ALS 

100 

CALL PMEAS(PEUL.EUL,PDHL( J).POVL(U) .2) 


DO 200 1*11 , 

22 



POHL< I )«0. 



200 

PDVL( I )*0. 




RETURN 

END 


PROGRAM SECTIONS 


> 

1 

NJ 

Name 

Bytes 


0 SCOOE 

9 1 2 

CO 

1 SPDATA 

1 67 


2 SLOCAL 

1052 


3 TIME 

136 


4 AS TATE 

160 


5 NS TATE 

1 12 


6 LMTPAR 

392 


T PART 

21 12 


8 TARGETS 

36 


9 DEBUG 

8 


10 MEASOUT 

648 


Attr f butes 







PIC 

CJN 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Nome 
0-00000000 HLMT 


variables 


Address 

Type 

Name 

6-00000000 

R*8 

AL 

10-00 000 1E0 

R*8 

DHCL 

10-000001 E8 

R*8 

OVCL 

9-00000004 

1*4 

IDEBUG 


Address 

Type 

Name 

3-00000038 

R*8 

DATEO 

3-00000068 

R*8 

OTA 

10-00000278 

R *8 

EOHL 

9-00000000 

1*4 

I ENTER 


Address 

Type 

Name 

3-00000070 

R*8 

DATER 

3-00000030 

R*8 

DTN 

10-00000280 

R*8 

EDVL 

8-00000004 

1*4 

IS 


Address 

Type 

Name 

3-00000020 

R*B 

DEL 

3-00000080 

R *8 

DT PRINT 

2-00000200 

1*4 

I 

2-00000204 

1*4 

J 




Page 6 


(i'll 


HLMT 


Pao* 1 


e-ooocoooc 

L*4 

JFLA» 

6-0000001 0 

R *8 LAT 

2-00000288 

R*a 

MEMO 

8-00000000 

1*4 MTVPE 

2-000002C0 

R*8 

PMEML 

5 -00000 068 

R * 8 RADE 

6-00000178 

R*a 

SIGGCP 

3-00000000 

R*8 T 

3-00000018 

R*8 

T 1 A 

3-00000000 

R *8 TIME 

3-00000060 

R*8 

TISN 

3-00000048 

R »8 TMEAS 

3-00 000078 

R*8 

TPRIfT 

3-00000050 

R *8 TRACK 

ARRAYS 

Address 

Type 

Name 

Bytes 

Di man* Iona 

6-OOOOOOC8 

R*8 

BKL 

16 

(2) 

6-OOOOOOA8 

R*8 

BL 

1 6 

(2) 

4-00000070 

R*8 

D 

24 

(3) 

4-00000083 

R*8 

DO 

24 

(3) 

4-00 00000 J 

R«8 

DF 

32 

(4) 

10-00000150 

R*8 

OHCS 

16 

(2) 

2-00000240 

R*8 

DM1 

24 

(3) 

2-00 OC0228 

R*8 

DM2 

24 

(3) 

10-00000160 

R*8 

DVCS 

16 

(2) 

4-00000020 

R*8 

E 

32 

(4) 

10-00000258 

R*8 

EOHS 

16 

(2) 

10-0000026R 

8*8 

EDVS 

16 

(2) 

2-00000150 

R*8 

EMI 

24 

(3) 

2-00 000 1 BO 

R*B 

EMU 

24 

(3) 

10-00000228 

R*B 

EMXG 

48 

(6) 

5-00000030 

R*8 

EP 

24 

(3) 

2-00000108 

R*8 

ETBI 

72 

(3. 3) 

2-00000078 

R*8 

ETBL 

72 

(3. 3) 

2-00000000 

R*8 

ETLB 

72 

(3. 3) 

2-00000168 

R*8 

ETLI 

72 

(3. 3) 

2-00 0002A0 

R*B 

EUL 

24 

(3 ) 

2-00000060 

R*B 

L 

24 

(3) 

2-00 000000 

R*8 

LE 

24 

( 3 ) 

10-000001 FO 

R*8 

LMU 

24 

(3) 

10-00000170 

R*8 

MS 

48 

(3. 2) 

10-00000000 

R*8 

MX 

48 

( 6 ) 

7-000006EO 

R*8 

PDML 

1 76 

(22) 

7-00000420 

R*8 

PDHS 

352 

(22. 2) 

7-00000790 

R*8 

PDVL 

1 76 

(22) 

7-CO 000580 

R*B 

POVS 

3 52 

(22, 2) 

2-00000258 

R*8 

PEMB 

24 

(3 ) 

2-00000210 

R*8 

PEMI 

24 

(3) 

2-00000270 

R*8 

PEML 

24 

(3) 

2-00 000 1 08 

R*8 

PETBI 

72 

( 3 , 3) 

2-00000288 

R*8 

PEUL 

24 

( 3 ) 

7-00000000 

R*8 

PX 

1 76 

(22) 

7-00000210 

R*8 

PXO 

1 76 

(22) 

7-OOOOOOBO 

R»8 

PY 

1 76 

(22) 

7-00 0002C0 

R*8 

PYO 

1 76 

(22) 

7-00000160 

R»8 

PZ 

1 76 

(22) 

7-00000370 

R*8 

PZO 

1 76 

(22) 

10-00000030 

R*8 

RGPS 

263 

(6 , 6) 

.0-00000208 

R*8 

RL 

32 

(2 . 2) 

10-000001 AO 

R*8 

RS 

64 

(2, 2, 2) 


Apr-1981 15: 

00: 53 

VAX-1 

Feb-1981 17: 

59:53 

_DBAO 

6-00000008 

R-e 

LON 

8-00000008 

1*4 

NS 

5-00000060 

R* 8 

RADM 

2-000002C8 

R*8 

TO 

3-00000028 

R*8 

TIN 

3-00000008 

R*8 

TNEXT 

3-00000010 

R*8 

TSTOP 


FORTRAN V2.0-2 
[D1 1R.GCP ]HLMT . FOR : 26 


8-00000010 

1*4 

MCOOE 

8-00000014 

R *8 

PI 

5-00000068 

R*B 

RE 

6-00000180 

R *8 

thet 

3-00000058 

R *8 

TIS 

8- 0000001C 

R*8 

TPI 

3-00000040 

R *8 

TZERO 


m" • i 




it, 










()i z- 


HLMT 


6-Apr-1 981 15 : 00:53 VAX-11 FORTRAN V2.0-2 Page 8 
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4-00000058 

R*8 

SF 

24 

(3) 


6-00000008 

R*8 

SKL 

16 

(2) 


6-OOOOOOB8 

R*8 

SL 

16 

(2) 


6-00 000018 

R*8 

TBNL 

72 

(3 . 

3) 

2-00 0000 1 8 

R*8 

TIE 

72 

(3, 

3) 

6-00000130 

R*8 

TIEO 

72 

(3. 

3) 

6-00000060 

R*8 

TNL 

72 

(3. 

3) 

6-OOOOOOEB 

R*8 

TNLK 

72 

O. 

3) 

4-00000040 

R*8 

WD 

24 

(3) 


5-00000030 

R*8 

X 

48 

<6) 


5-00000000 

R*8 

XD 

48 

(6) 



LABELS 











Address 

Labe 1 

Address 

Label 

Address 

Label Address 

Labe 1 

Address 

Label 

Address 

Label 

** 

10 

1-00000000 

12 * 

1 -OOOOOOOD 

13' 0-0000019D 

15 

• • 

20 

• * 

30 

« • 

40 

1-00000015 

42 ’ 

1-00000023 

43' 1-00000030 

44 ' 

1-00000053 

45 ' 

(-00000076 

46* 

0-000002EA 

50 

• * 

100 

• * 

200 






FUNCTIONS ANC 

SUBROUTINES REFERENCED 









AM AT 

MAT AB 

MINV3 


MTHSDASIN 

MTHSDCOS MTHSDSIN 

PMEAS 

SPEMI 



SPETBt 

UNIT 

VMAO 


WET 








Total Space Allocated ■ 5635 Bytea 


COMMAND QUALIFIERS 

FORTRAN /LIST GC P . INDATA .MAT AB .OUT DATA , RUNG , ON AV , EPHEM, TRUE* , SPRESS , OCCULT , GPERT , GCPSEQ , V ISI BLE .GENENV . TREG .GYROUT . RAT E , BMAT , CMA 

/CHECK* (NO BOUNDS .OVERFLOW) 

/DEBUG* ( NOSYMBOL S . TR AC EBACK ) 

/F77 /NOG FLOATING /14 /OPTIMIZE /WARNINGS /NOO_lXNES /NOMACHINE.CODE /CONT INUATIONS-1 9 


COMPILATION STATISTICS 

Run Time: 3.5B seconds 

Elapsed Tima: 56.86 seconds 

Page Faults: 429 

Dynamic Memory : 160 pages 




1 1 


2. 7.2.2. 1 COMPUTE PARTIALS WITH RESPECT TO ESTIMATED 

TRANSFORMATION FROM INERTIAL TO BODY COORDATES (SPETBI) 

SPETBI, called by HLMT and HSTAR, coaputes Che aenaivlcy of Che estimated 
inertial to body transforaation to the individual eleaenta of the eatiaated 
state. This routine is essentially unsupported by any other sMjor routines. 


Processor Requireaents 
Recognising that 

f qo 2+ 9l 2- <h 2 ~ 93 2 2(qjq 2 + 939 q) 


{qij} ■ 2(qiq 2 - q3qo) 
2(qiq3 - q29o) 


9o 2 - 91 2 * $ 2 2 ~ h 7 
2(q2q3 - 9i9o) 


2(qi<33 - q2qo) 
2(9293 + qiqo) 

qo 2 - 9i 2 - 92 2+ q3 2 


since 


x i - qi -7 




for i ■ 7, 8, 9, and 10 


90 93 "92 


-93 +90 91 for i 


92 ”9l 90 


91 92 93 


2 92 -9l 90 for i - 8 


93 “90 “91 


-92 9l ~9o 


91 92 93 for i * 9 


90 93 “92 


“93 90 91 


2 -qo “93 92 for i - 10 


9l 92 93 


{^ij^ " [ 0 ] for i < 1 and i > 10 


A-2 51 


SPETBI (I,Q) 



case State Element I 


1 thru 6 X ^ — " 7 

Return zero Compute 
partial partial 
array WKT E(l) 


Compute 
partial 
WRT E(2) 


Compute 
partial 
WRT E(3) 


Compute 
partial 
WRT E(4) 


Multiply all partial elements by 2 


Figure A- 40 


A-252 


'T 




6-Apr-1081 15:01:51 VAX-11 FORTRAN .2.0-2 
1 1 -Sep-1 980 11:56145 _DBAO: [01 1R.GCP JSPETBI .FOR : 3 


0001 


0002 

0003 

0004 


> 

I 

ro 

Ui 

OP 


0005 

0006 


0007 


0008 

0009 

0010 
001 1 


0012 

0013 

0014 

0015 

0016 

0017 

0018 

0019 

0020 


c» 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c* 

c 

c 

• c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE SPETBI(l.Q) 

***«***•****♦***••»•***• 

SUBROUTINE SPETBI COMPUTES THE PARTIAL OF THE ESTIMATED 
TRANSFORMATION FROM INERTIAL TO BODY COORDINATES. 

INPUT PARAMETERS . _ „ ____ 

I « THE INTEGER CONTROLLING THE SPECIFIC 

PARTIAL BEING COMPUTED 
(RANGE 1-10) 

E • THE ESTIMATED QUATERNI AN ARRAY 

OUTPUT PARAMETERS 

0 « THE OUTPUT PARTIAL ARRAY (3,3) 

CALLED BY HSTAR AND HLMT 


COMMON BLOCKS 
INCLUDE 'ASTATE.COM' 

COMMON /ASTATE/ DE(4) , E ( 4 ) . W0< 3 ) . SF ( 3 ) . D( 3 ) , 00( 3) 
REAL *8 DE.E,*I0.SF,0,DD 

ATTITUDE STATE AND CONSIDERED PARAMETERS 


DE 

OITERENTIAL OF QUATERNIONS 

E 

QUATERNIONS 

WD 

GYRO 

DRIFT RATE (RAO/SEC) 

SF 

GYRO 

SCALE FACTOR 

D 

GYRO 

NON-ORTHOGANALITY (RAO) 

DO 

GYRO 

RELATIVE ORIENTATION (RAD) 


C** 

C 

C** 

C«» 

C 

c«* 

10 

15 

c*» 

c 

c»« 

20 


DIMENSION 0(3.3) 

RE AL*0 0 * , *, 

BRANCH TO THE APPROPRIATE SECTOR ON I 

GO TO ( 1 0,10, 10,10, 1 0, 10.20,30,40,50) , I 

ZERO 0 ARRAY - POSITION OR VELOCITY ELEMENT PARTIAL 

DO 15 J»1 .3 
DO 15 K=1 ,3 
Q< J , K ) =0 . 

RETURN 

COMPUTE PART I A LS NRT 0(0) 

Q( 1 ,1 ) = E( 1 ) 

Q( 1 ,2)*E(4) 

0( 1 .3) — E(3) 

0( 2, 1 ) *-E( 4) 

0( 2,2)*E( 1 ) 

0( 2 ,3 ) *E ( 2 ) 

0( 3,1 )«E(3) 

Q( 3,2)«-E(2) 

Q{ 3, 3) *E ( 1 ) 


Page 



1 

i 


SPETBI 



6-Apr-1®81 15:01:31 VAX-11 FORTRAN V2.0-2 

11 -Sep-1 9B0 11:56:45 _OBAO: [01 1 R.GCP]SPETBI .FOR ;3 


0021 GO TO 100 




<;••••« 




C 

COMPUTE PARTI A LS WRT 0(1) 






0022 

30 

0( 1»1)*E(2) 


0023 


Q( 1 .21*6(3) 


0024 


0( 1 , 3 ) = E (4 ) 


0025 


0( 2. 1 ) = E ( 3 > 


0026 


0( 2.2)*-E(2) 


0027 


0( 2 . 3 ) =E ( 1 » 


0028 


0( 3. 1 )=E(4) 


0029 


0( 3, 2) *-E( 1 ) 


0030 


0( 3, 3) *“E( 2) 


0031 


GO TO 100 



C 

COMPUTE PART I A LS WRT 0(2) 






0032 

40 

0(1.1 ) *- E ( 3 ) 


0033 


0( 1 . 2 ) «E ( 2 ) 


0034 


0( 1 ,3) »-E( 1 ) 


0035 


0( 2.1 ) =E ( 2 ) 


0036 


01 2 , 2 ) =E ( 3 ) 


0037 


Q( 2 , 3 ) 3 E ( 4 ) 


0038 


0( 3.1)-E(1) 


0039 


0( 3 • 2 ) *E ( 4 ) 

> 

0040 


0( 3.3)--E(3) 

ro 

0041 


GO TO 100 

Ui 


c*** • 

c 

COMPUTE PART K A LS WRT 0(3) , 



c*** • 



0042 

50 

0(1.1 )*-E(4) 


0043 


0( 1 ,2)=E< 1 ) 


0044 


0( 1 ,3)-E(2) 


0045 


0( 2.1 )*-E( 1 ) 


0046 


0( 2 . 2) *-E( 4) 


0047 


0( 2 , 3 ) *E ( 3 ) 


0048 


0( 3. 1 )«E(2) 


0049 


0( 3.2)*E(3) 


0050 


0( 3 » 3) *E (4 ) 


0051 

100 

DO 200 d-1.3 


0052 


00 200 X»1 ,3 


0053 

200 

0( J.K)>2.*0(U.X) 


0054 


RETURN 


0055 


END 



A-255 


SPETBI 


VAX-11 FORTRAN V2.0-2 
_DBAO:[D1 1 R.GCP] SPETBI -FOR ; 3 


Page 
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PROGRAM SECTIONS 


6-Apr-l 9B1 
1 1 -Sep-1 9B0 


15:01:51 
1 1 : 56: <5 



Name 

Bytes 

At tr i butes 







0 

SCOOE 

349 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

2 

•LOCAL 

2B 

PIC CON REL 

LCL 

NOSMR 

NOEXE 

RD 

WRT 

LONG 

3 

ASTATE 

160 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 SPETBI 


VARIABLES 


Address 

Type 

Name 


Address 

Type Name 


Address 

T ype Name 





AP-00 000004* 

1*4 

I 


2-00000000 

1*4 J 


2-00000004 

1*4 K 





ARRAYS 













Address 

Type 

Name 


Bytes 

D i mansions 








3-00 000070 

R»8 

0 


24 

(3) 








3-00 OOOOBB 

R*e 

00 


24 

(3) 








3-00000000 

R*8 

DE 


32 

(4) 








3-00000020 

R*8 

E 


32 

(4) 








AP-OG 000008* 

R»8 

0 


72 

<3. 3) 








3-00 000058 

R*8 

SF 


24 

(3) 








3-00000040 

R*8 

MD 


24 

(3) 








LABELS 













Address 

Labe 1 


Address 

Label 

Address 

Label 

Address 

Label 

Address 

Label 

Address 

Label 

0-00000020 

10 


• • 

15 

0-00000051 

20 

0-0000008C 

30 

0-OOOOOOC6 

40 

0-00000100 

50 

0-00 000 13S 

100 


• • 

200 








Total Space Allocated » 537 By tea 
COMMANO QUALIFIERS 

FORTRAN /LIST GC P , INOATA ,MAT AB, OUT DATA , RUNG . ON AV , EPHEM, TRUEA , SPRESS , OCCULT ,GPERT .GCPSEQ, VISIBLE .GENENV , TREG .GYROUT , RAT E. BMAT , CMA 
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F*0* * 


COMPILATION STATISTICS 


Run Tint*: 
Elapsed Time: 
Page Faults: 
Dynamic Memory: 


2.07 seconds 
36.65 seconds 
324 

160 pages 


> 


2. 7. 2. 2. 2 COMPUTE PARTIALS OF ESTIMATED MEASUREMENT VECTOR 
IN INERTIAL SPACE ISPEMI) 

SPEMI called by HLMT, compute* the aenaivity of the estimated landmark 
tracker meaaurement vector in inertial apace with respect to the element* of 
the estimated state. This routine is unsupported by o:her major routine*. 


Processing Requirements 


Recognizing that 


and 


Bi - L 

- P 

. 

‘-1 ' 
0 

3xi 

0 

3gi , 

" 0 

3xi 

_ 0 


o 

3Ml 

0 

3xi 

-1 


” o 

3MI _ 

o 

3xi 

0 


for xi - x 


for Xi * y 


for xi * z 


otherwise 


where 

Bi 

L 


P 



- Estimated measurement vector in inertial space 
• Landmark position vector in inertial space 

» Spacecraft estimated position vector in 
inertial space. 
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0001 


SUBROUTINE SPEMtd.X 1 


C 

C 

subroutine spemi conpl * . tm partial of the measurement 


c 

VECTOR IN INERTIAL SPA^. . 'T THE ESTIMATCO STATE 


c 

INPUT PARAMETERS 


c 

I • THE INTEGER CONTROLLING THE INDIVIDUAL 


c 

PARTIAL (RANGE 1-10) 


c 

OU T PU T PARAMETERS 


c 

* • THE OUTPUT PARTIAL VECTOR (3.1) 


c 

CALLED BV MLMT 




0002 


DIMENSION X ( 3 ) 

0003 


REAL'B X 

0004 


IF ( 1 . GT . 3) GO TO 50 

0005 


DO 20 J«1 .3 

0006 

20 

x< u(- 0 . 

0007 


X( 1 |.-1 . 

0006 


RE TURN 

0009 

SO 

DO 60 J«1.3 

0010 

60 

x< U)-0. 

0011 


RE TURN 

0012 


ENO 


■W 1 ' 

x 


program sections 



Naae 

Bytes 

Attributes 







0 

♦CODE 

66 

PIC CON REL 

LCL 

SHR 

EXE 

RO 

N0MR1 

LONG 

3 

♦local 

24 

PIC CON REL 

LCL 

NOSH* 

NOEXE 

RD 

MRT 

LONw 


ENTRY POINTS 

Address Type Nan* 
0-00000000 SPENI 


VARIABLES 


Address T-, ,.e 


N»«*e 


Address Type 
A P—00 0000040 1*4 


I 


2-00000000 1*4 J 


A- 2 60 


«ss;s 


ARRAYS 


Address 


X ypf* HR*S 


tp-00 000008P R»6 * 


Bytes Ot mens Ion* 
34 (3) 


L.1IUS 


Address tede I 


Address Lebe< 
0-00000034 50 


Address 
.. M 


Total Spece Allocated • J ® yt 

#-kuc uv TREG.CYROUT.RATt. 

W * UfU,,S 

fortran /t!ST gcp.ihoata.natab.outdata.r 

/CHECN.tNOBOUNOS.UVERFLON) /MACHINE. CODE /CONT INUATIOHS-t# 

/OEBUG.INOSYNMtS^TRACEMC ^ ti|(12E /WARNlN GS /NOO.ttKM 

/FTT /NOG.FLOAT INO 


■MAT. cm 


COMPILATION STATISTICS 


Run tins: 
Elapsed tins! 
Page f au 1 1 • : 
Oyna-ic Meaoryi 


0.56 seconds 
11.04 second* 
306 

160 page* 






2. 7. 2. 3 MEASUREMENT PARTIALS FOR STAR TRACKER (K) (HSTAR) 

HSTAR, called by MPART, compuf.es the sensivity of the star tracker 

Processing Requirements 

A unit vector along the optical axis at each star tracker 00 is 

establ iahed and tr.nafomed to inertial apac. . The 

transformation from star tracker coordinates to inertial ' 

partial. o£ thi. unit vector uith re.pect to tne element o£ toe .stilted 

state are given by 


where 


3]js 

3xi 


(bij) 
{Sij} 
( a ij } 


{b ij } { ^ Haij) 


Transformation from body to star tracker coordinates. 

Estimated transformation from inertial to body coordinates 

Ideal transformation from star tracker to inertial 
coordinates. 


HSTAR VCLR 


i j 

» f 


Compute star unit vector in inertial coordinates 


Compute estimated transformation from star tracker to inertial 
space 


Computed estimated unit vector in ST coordinates 


Compute estimated measurement 


Compute partial of estimated transformation from Inertial 
to body WRT estimated state (SPETBI) 


Compute partials of estimated unit vector 


Compute unit vector partials to measurement partials 


Compute partials of unit vector with respect to states 
7 through 10 


Fill all other measurement partial elements (1 through 6) 
and (11 through 22) with zero 


f 


Figure A-42 



f 


i 
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00 IOC 
00200 
00300 
00400 
00500 
00600 
00700 
COBOO 
00900 
01000 
01 1 00 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 
02500 
> 02500 

02500 
~ 02500 

W 02500 
02500 
03500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02500 
02600 
02600 
02600 
02600 
02600 
02600 
02600 
02600 
02600 
02600 
02600 
02600 


0001 


0002 

0003 

0004 


c* **•*« 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c* •••< 

c 

c 


SUBROUTINE HSTAR< K > 


,»*«»«•»♦•»********< 


,****♦****.•* + * 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


0005 

0006 

0007 


c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE HSTAR COMPUTES THE PARTIALS FOR THE KTH STAR 
TRACKER MEASUREMENT VECTOR. 

INPUT PARAMET nS qr qf the kt h STAR TRACKER 

K * cicmcmtq 7-10 ARE USED AS THE IDEAL 

STATE ~ inertial TO BODY quaternian elements 

T Due - STAR TRACKER NOMINAL TO BODY TRANSFORMATION 

tbns - s>tak star tracker t0 nominal 

TNS * TRANSFORMATION (MISALIGNMENT ARRAY) 

£ * ESTIMATED QUATERNIAN ARRAY 

OUTPUT PARAMETERS p&RTIAL QF THE STAR TRACKER HORAZONTAL 

DEFLECTION .... 

pnvs = PARTIAL OF THE STAR TRACKER VERTICAL 
DEFLECTION 


COMMON BLOCKS 

REAL.8 PX^Y.PZ.pio.PYD.PZD.PDHS.PDVS.PDHL.POVL 


PARTIALS OF THE RESPECTIVE MEASUREMENTS MADE 
FOR GPS 


PX 

PY 

PZ 

PXO 

PYD 

PZO 


PARTIALS OF X POSITION MEASUREMENT 
. - y » 

„ M 

" • z 

« - X VELOCITY 

N M y * * 

Z 


-o, ... .Jt’SBySff'SJKU, 

povi = ■ " VERTICAL 

for landmark tr *^ e p « rtials of horizontal diflection 
pdvl = ” ' vertical 

INCLUDE •STARPAR.COM- TNS ( 3 , 3 . 2 ) . T BNS ( 3 , 3 . 2 ) . 

COMMON /STARPAR/ BS ' =; 2 > ! ' ‘ l ' I' "5 ’ 

BSK ( 2»2),SSK(2,2) t TNSK( 3,3,2 ) 

REAL*8 BS.SS , TNS, TBNS. BSK, SSK.TNSK 

5,« e , S T SUBSC.PT REFERS TO THE 

TRACKER USED 

* NO*SE STANDARD^ DEVIATION - ACTUAL (RAD) 

: M^SAL I GNMENT ARRAY -TRANSFORMATION FROM 
STAR TRACKER TO NOMINAL 
, ORIENTATION ARRAY - TRANSFORMATION FROM 


BS 

SS 

TNS 


TBNS 


FOR : 1 0 


> 

I 

r-o 


mstab 
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02600 


• 

C 



NOMINAL TO BODY 

02600 


• 

c 


BSK 

« BIAS - KNOWLEDGE (RAD) 

02600 


• 

c 


SSK 

* NOISE STANOARD DEVIATION -KNOWLEDGE (RAD) 

02600 


• 

c 


TNSK 

= MISALIGNMENT KNOWLEDGE ARRAY - TRANSFORMATION 

02600 


• 

c 



FROM STAR TRACKER TO NOMINAL 

02600 


• 

c 




02600 

0008 



INCLUDE 'ENVIR. 

COM’ 

02700 

0009 

• 


common 

/ENVIR/ STATE ( 10) .PROFILE! 10,4), INIT 

02700 

0010 

• 


REAL*8 

STATE. PROFILE 

02 '00 


« 

c 




02 700 


• 

c 


REAL WORLO STATE PARAMETERS 

02700 


* 

c 




02700 


• 

r 


STATE STATE VALUES; X , V , Z , XD , YD , ZD , EO , E 1 . E2 , E3 

02700 


• 

c 


PROFILE ATTITUDE PROFILE-TIME (SEC) VS 

02700 


• 

c 



INERTIAL ANGULAR RATES (RAD/SEC) 

02700 


• 

c 


INI 

T INTEGRATION INITIALIZATION KEY (-1) 

02700 


• 

c 




02700 

0011 



INCLUDE 'ASTATE 

• COM' 

02800 


• 

c 




02800 

0012 

m 


COMMON 

/ASTATE/ 0E(4) ,E(4) , MD( 3 ) , SF( 3) ,D{3 ) , 0D( 3 ) 

02800 

0013 

0 


REAL*8 

OE.E.WO.SF 

,0.00 

02800 


0 

c 




02800 


0 

c 


ATTITUDE 

STATE ANO CONSIDERED PARAMETERS 

02800 


0 

c 




02800 


0 

c 


D_ 

01 FERENT I AL OF QUATERNIONS 

02800 


0 

c 


E 

QUATERNIONS 

02800 


0 

c 


WO 

GYRO DRIFT RATE (RAD/SEC) 

02800 


0 

c 


SF 

GYRO SCALE FACTOR 

02800 


0 

c 


D 

GYRO N0N-0RTH0GANAL1TY (RAD) 

02800 


0 

c 


DO 

GYRO RELATIVE ORIENTATION (RAO) 

02800 


0 

c 




02800 

0014 



INCLUDE 'MEAS0UT.COM' 

00100 

0015 

0 


COMMON /MEASOUT/ MX ( 6 ) , RGPS ( 6 , 6 ) , OHCS( 2 ) , DVCS( 2 ) , MS( 3 ,2), 

00200 


0 


• 

RSI 2 .2.2) , DHCL , DVCL , LMU( 3) , R L(2 , 2 ) , EMXG( 6 ) . 

00300 


0 


• 

EDHS ( 2 ) . ED VS ( 2 ) . EDHL.EOVL 

00400 

ooie 

0 


REAL*8 MX, RGPS, 

DHCS. DVCS, MS, RS, DHCL, DVCL, LMU.RL. EMXG, 

00500 


0 


• 

EDHS . OVS. EDHL.EOVL 

00600 


0 

c 




00700 


0 

c 




00800 


0 

c 

MEASUREMENT OUTPUT PARAMETERS 

00900 


0 

c 


MX 

* POSITION/VELOCITY STATE MEASUREMENT - GPS 

0*000 


0 

c 



(KM. KM/SEC) 

01100 


0 

c 


EMXG 

• ESTIMATED POSITIOM/VELOC I TV STATE 

01200 


0 

c 



MEASUREMENT - HGPS 

01300 


0 

c 


RGPS 

« STATE MEASUREMENT NOISE COVARIANCE 

01400 


0 

c 



(KNOWLEDGE) -GPS ( KM* *2 . KM/SEC**2 ) 

01500 


0 

c 


DHCS 

• STAR MEASUREMENT HORIZONTAL DEVIATION 

01600 


0 

c 



FROM BORESIGC" - START (RAD) 

01700 


0 

c 


OVCS 

■ STAR MEASUREMENT VERTICAL DEVIATION 

01800 


0 

c 



FROM BORESIGHT - START (RAD) 

01900 


0 

c 


EDHS 

* ESTIMATED STAR MEASUREMENT HORIZONTAL 

02000 


0 

c 



DEVIATION FROM BORESIGHT (RAD) 

02100 


0 

c 


EDVS 

* ESTIMATED STAR MEASUREMENT VERTICAL 

02200 


0 

c 



DEVIATION FROM BORESIGHT (RAD) 

02300 


0 

c 


MS 

• STAR MEASUREMENT UNIT VECTOR (SECOND 

02400 


0 

c 



SUBSCRIPT REFERS TO TRACKER) - START 

02500 


0 

c 


RS 

- STAR MEASUREMENT NOISE COVARIANCE 
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02600 



02700 



02800 



02900 



03000 



03100 



03200 



03300 



03400 



03500 



03600 



03700 



03800 



02900 

0017 


03000 

03100 

03200 

03300 

0018 


03400 

03500 

03600 

03700 

03800 

03900 

0019 


04000 

0020 


04100 

0021 


04200 

0022 


04300 

0023 


04400 

04500 

04600 

04700 

0024 


04800 

0025 


04900 

0026 


05000 

0027 


05100 

0028 


05200 

05300 

05400 

05500 

0029 


05600 

0030 


05700 

0031 


05800 

05900 

06000 

06100 

0032 


06200 

0033 


06300 

06400 

06500 

06600 

0034 


06700 

0035 


06800 

0036 


06900 

0037 


07000 

0038 


07100 

0039 


07200 


C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 


DHCL 

DVCL 

EOHL 

EDVL 

LMU 

RL 


(KNOWLEDGE) - START <RAD*»2) 
landmark MEASUREMENT HORIZONTAL DEVIATION 
FROM BORESIGHT - LAMKT (RAD) 
LANDMARK MEASUREMENT VERTICAL DEVIATION 
FROM SORESIGHT - LAMKT (RAD) 
ESTIMATED LANDMARK MEASUREMENT HORIZONTAL 
DEVIATION FROM BORESIGHT (RAD) 
ESTIMATED LANDMARK MEASUREMENT VERTICAL 
DEVIATION FROM BORESIGHT (RAD) 
LANDMARK MEASUREMENT UNIT VECTOR - LAMKT 

landmark measurement noise covariance 

(KNOWLEDGE) - LAMKT (RAD««2) 


D I MENS ION TBII3.3) ,TIB(3,3).TBS(3,3) ,US(3) , UB( 3 ) . U I ( 3 ) , 
dimension^buj.^ £ tsb(3i3)iETB1(3i „ iETS1(3 .3).EUl(3). 

PEUS ( 3 . ' 0 I ,PETBl(3,3),UIP(3),ATEMP(4),T1(3,3), 

T2(3 3 ) E U S f 3 ) . T EMP ( 3 ) 

RF.AL*8 EUS.ETBI .ETBS.ETSB.ETSI .EUI.PETBI.PEUS.TBI .TBS.TIB.UB, 
UI.UIP.US. A TEMP , T 1 , T2 , T EMP 


C , . 

c COMPUTE TIB - TRUE BOOT TO INERTIAL TRANSFORMATION 

C . •*•..*. >'“* *'**'*• ......A,.*....* ****** * 

DO 5 I «1 ,4 

ATEMP( I ).STAT .(1+6) 

5 CONTINUE 

CALL AMAT(ATEMP.TBI ) 

wT 1 • • *1 • > * • *•*••• **** 

C COMPUTE TBS - TRUE STAR TRACKER TO BODY TRANSFORMATION 

* *** * 

DO 100 1*1.3 
DO 100 J*1 . 3 
T 1 ( I , J ) *TBNS ( I . J • X ) 

100 T2( I ,d )*TNS( I . J.K ) 

CALL MATAB(T1 .T2.TBS.3.3.3) 

c COMPUTE UNIT VECTOR TO STAR IN TRACKER COORDINATES 

C*« ,....*••*•* *********** * ••*••••** 

US( 1 )=0. 

USl 2 ) * 0. 

US( 3 ) = 1 • *,****•*•••*•*••••»• 

c* •••••**•*••* *•***• ************ ********** * 

c TRANSFORM TO INERTIAL SPACE *.,*,««*••*•••*•*** 

CALL MATAB(TBS,US.UB,3,3,1) 

CALL MATAB(TIB.UB.UI,3.3,1 ) 

c» ••••••**••*«***•*• ■ •***•***• ***************** 

c COMPUTE ETSB - ESTIMATE OF TSB „*,*****«**•••••* 

* * 

DO HO I«1 .3 
DO 110 J* 1 ,3 
T 1 ( I . d ) *T8NS ( I , d . K ) 

110 T2(I ,d )«TNSK( I ,d,K) 

CALL MATABf T 1 ,T2 , ETBS, 3. 3,3) 

CALL M INV3( E TBS . ETSB ) ^ 




HSTAR 
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07300 


C 

COMPUTE EUI - ESTIMATED UNIT VECTOR IN STAR TRACKER 

07400 


c 

COORDINATES 

07500 


c* •+* 


07600 

0040 


CALL AMAT(E.ETBI) 

07700 

0041 


CALL MATAB(ETSB,£TBI ,ETSI .3,3, 3) 

07800 

0042 


CALL MATABI ETSI .UI , EUS, 3 .3. 1 ) 

07900 


c 


08000 


c* *•• 


08100 


c 

CALCULATE ESTINATEO MEASUREMENT 

08200 


c* 


08300 


c 


00400 

0043 


EDVS(K )»ASIN< US ( 1 ) ) 

08500 

0044 


EDMS ( K ) *AS I N ( US ( 2 1 /COS ( EDVS ( K ) ) ) 

08600 


o 


08700 


c 

COMPUTE PART IALS OF UNIT VECTOR 

08800 


o • • * 


08900 

0045 


00 10 1=1,3 

09000 

0046 


DO 10 0*1,10 

09100 

0047 

10 

PEU5 < ! ,U)«0. 

09200 

0048 


DO 20 U*7, 10 

09300 


c* *«• 


09400 


c 

COMPUTE PART IALS OF ET8I HURT Q < J ) . J« 7 , 1 0 

09500 


c • * * * 


09600 

0049 


CALL SPETBI I J.PETBI ) 

09700 


c* •** 


09800 


c 

SET UP ARRAY FOR PART1ALS OF ESTIMATEO UNIT VECTOR 

09900 


c* ••• 


10000 

0050 


CALL MATABIPETBI .Ul.UIP. 3,3,1 ) 

10100 

0051 


CALL MAT AB( E TSB, U I P , TEMP ,3,3,1 ) 

10200 

0052 


00 25 1=1,3 

10300 

0053 

25 

PEUSf I , U ) » TEMPI I ) 

10400 


c* •+* 


10500 


c 

CONVERT UNIT VECTOR PART IALS TO MEASUREMENT PART IALS 

10600 


c* ••• 


10700 

0054 

20 

CALL PMEAS(TEMP,EUS,PDHS(J,K) ,P0VS(a,K),t) 

10800 

0055 


DO 30 1=11 ,22 

10900 

0056 


PDHS( 1 ,K)«0. 

11000 

0057 

30 

PDVS ( I ,K)=0. 

11100 

0058 


DO 40 1=1,6 

11200 

0059 


POHS( I ,K)=0. 

11300 

0060 

40 

POVS( I , K ) =0 • 

11400 

0061 


RETURN 

11500 

0062 


ENO 
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PROGRAM SECTIONS 



Name 

Bytes 

At t r 

’ i butes 







0 

scooe 

485 

PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

NONRT 

LONG 

1 

SPOATA 

8 

PIC 

CON 

REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

2 

S LOCAL 

1 476 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 

3 

PART 

2112 

PIC 

OVR 

rel 

GBL 

SHR 

NOEXE 

RO 

WRT 

LONG 

4 

ST ARPAR 

560 

PIC 

OVR 

REL 

G8L 

SHR 

NOEXE 

RD 

WRT 

LONG 

5 

ENVIR 

404 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

6 

ASTATE 

160 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

7 

MEASOUT 

648 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
O'OOOOOOOO HSTAR 


VARIABLES 


Address 

.ypa 

Nam* 

Address 

Type 

Nam* 

7-000001 EO 
2-00000488 

R«8 

1*4 

DHCL 

I 

7-000001 E8 
5-00000190 

R*8 

1*4 

OVCL 
IN IT 


Address 

Type 

Nam* 

Address 

Type 

Name 

7-00000278 

R*B 

EDML 

7-00000280 

R »B 

EDVL 

2— 00 00048C 

1*4 

J 

A P—00000004* 

1*4 

K 


ARRAYS 


Address 

Type 

Nam* 

Bytes 

D i mens ton* 

2-00 0003A8 

R*8 

A TEMP 

32 

(4) 

4-00000000 

R*8 

as 

32 

(2, 2) 

4-00000160 

R*8 

BSK 

32 

(2. 2) 

6-00000070 

R»8 

D 

24 

(3) 

6-00 000088 

R*8 

DD 

24 

(3) 

6-00000000 

R*8 

DE 

32 

(4) 

7-00 0001 50 

R*8 

DHCS 

16 

(2) 

7-00000160 

R*8 

DVCS 

16 

(2) 

6-00 0C0020 

R*8 

E 

32 

( 4 > 

7-00000258 

R*8 

EOHS 

16 

(2) 

7-00000268 

R*8 

EOVS 

16 

(2) 

7-00000228 

R*8 

EMXG 

48 

(6) 

2-000001 80 

R*8 

ETBI 

72 

(3. 3) 

2-00000120 

R*8 

ET8S 

72 

(3, 3) 

2-00000168 

R*8 

ETSB 

72 

(3. 3) 

2-000001 F8 

R*8 

ETSI 

72 

(3, 3) 

2-00000240 

R*8 

EUI 

24 

(3) 

2-00000458 

R*8 

EUS 

24 

(3) 

7-000001 FO 

R*8 

LMU 

24 

(3) 

7-00000170 

R*8 

MS 

48 

(3, 2) 

7-00000000 

R*8 

MX 

46 

(6) 

3-00 O006E0 

R*8 

PDHL 

1 76 

(22) 

3-00000420 

R*8 

PDHS 

352 

(22, 2) 

3-00000790 

R*B 

PDVL 

1 76 

(22) 


S9Z-V 


MS TAR 
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VAX-11 FORTRAN V2.0-2 

Page 6 


9-Feb-1 9S1 

18:15:38 

_DBAO: [ 0 1 1R.GCP]HSTAR.FOR; 10 



3-00 000580 

R*a 

PDVS 

352 

<22. 

2) 

2-00 000348 

R*8 

PETBI 

72 

<3. 

3) 

2-00000258 

1*8 

PEUS 

240 

( 3 , 

10) 

5-00000050 

R*8 

PROFILE 

320 

<10, 

4) 

3-00000000 

R*8 

PX 

1 76 

(22) 

3-00000210 

R*8 

PXD 

1 76 

(22) 


3-00000080 

R*8 

PY 

1 76 

(22) 


3-00 0002C 0 

R*a 

PYD 

1 76 

(22) 


3-00000160 

9*8 

P2 

1 76 

(22) 


3-00000370 

R*8 

PZD 

1 76 

(22) 


7-00000030 

R*8 

RGPS 

2B8 

(6. 

S) 

7-00000208 

R*8 

RL 

32 

(2. 

2) 

7-00 0001 AO 

R*8 

RS 

64 

(2. 

2. 

6-000C0058 

R*8 

SF 

24 

(3) 


4-00000020 

R»8 

ss 

32 

(2. 

2) 

4-00000180 

A*8 

SSK 

32 

(2, 

2) 

5-00000000 

R*8 

STATE 

80 

(10) 

2-00 0003C8 

R*8 

T 1 

72 

(3. 

3) 

2-00000410 

R*B 

T2 

72 

(3, 

3) 

2-00000000 

R*8 

TBI 

72 

(3 . 

3) 

4-00 0000D0 

R*8 

TBNS 

1 44 

(3. 

3. 

2-00 00009C 

R*8 

TBS 

72 

(3. 

3) 

2-00000470 

R»8 

TEMP 

24 

<3) 

2-00000048 

R*8 

TIB 

72 

(3. 

3) 

4-00000040 

R*8 

TNS 

1 44 

(3, 

3. 

4-000001 AO 

R*B 

TNSK 

144 

(3. 

3. 

2-000000F0 

R*B 

UB 

24 

(3) 


2-00000108 

R*B 

UI 

24 

(3) 


2-00000390 

R*8 

UIP 

24 

(3) 


2-00 0000D8 

R»B 

US 

24 

(3) 


6-00000040 

R*8 

WD 

24 

(3) 



LABELS 


Address 

Labe 1 

Address 

Label 

Address 

Label 

Address Labe 1 

Address 

Label 

Address 

Label 

• • 
• • 

5 

100 

• • 
* • 

10 

110 

• • 

20 

• • 25 

• • 

30 

• • 

40 

FUNCTIONS AND 

SUBROUTINES 

REFERENCED 









AMAT 

MATAB 

M2NV3 


mthsdasin 

MTHSDCGS 

PMEAS 

SPETBI 





Total Space Allocated ■ 5853 Bytaa 


command qualifiers 

fortran /list gcp, indata. matab.outdata. rung. dnav.epmem.truea.spress, occult, gpert.gcpseq. visible. genenv.treg.gvrout. rate, mat. cma 

/CHECK* (NO BOUNDS .OVERFLOW) 

/DEBUG* ( NOSYMBOLS, TRACEBACK) 

/F7T /NOG. FLOAT ING /I4 /OPTIMIZE /WARNINGS /NOD.LINES /NOMACHINE CODE /CONT INUATI0NS-19 
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COMPILATION STATISTICS 


Run Tim*: 
Elapsed Tim*: 
Pag* Faults: 
Dynamic Memory: 


2.72 seconds 
45.11 seconds 
398 

160 pages 


R«0* 


2.7.3 Make Measurement Updates (UPDATE) 

A Carlton Square Root filter shall be used to estimate the spacecraft 
attitude and position. The filter calculates a new estimate for the state and 
model parameters each time a measurement becomes available. The correction 
depends on the difference between the actual measurement and the predicted 
measurement and the value of the gain matrix computed from the covariance of 
the measurement noise and the covariance of the state estimate. Every time 
the state and model parameters are corrected by the filter, the covariance 
matrix for the state and model parameters is also changed to reflect the 
additional knowledge contained in the measurement. 

A triangular formulation is used to avoid the possibility of a covariance 
matrix which is not positive semi— de finite and the resulting divergence of the 
state estimate and failure of the recursive algorithm. The square root 
formulation provides twice the effective numerical precision of Kalman's 
original formulation and guarantees a poeitive definite covariance matrix. 


The square root S of the covariance matrix P is defined by 

P = SST 

The Cholesky method for calculating the square root of a matrix shall be used 
to calculate the square root S of the covariance matrix P at each measurement 
update. The equations which define the Cholesky method are 




Pi- - y sik 2 
k-i+l 


Sji - I Pji “ l s jk S ik 
1 k-i+l 


Sii . J = i-l»* 


where 

n * dimension of covariance matrix P. 

Pij - element of P matrix. 

Sij * element of S matrix. 

The matrix S is upper trianRular. The equation for the elements of S must be 
evaluated with the initial index i-n. The index i is decremented by 1 until 
the final value i-1 is achieved. Evaluation in this order causes no 
references to uncalculated elements of the S matrix. 

"Die filter equations shall use the difference between the reference 
measurement and the actual meaurement to update the state measurement. It 
uses the current covariance matrix which represents the estimate uncertainties 
in the estimated and considered parameters. 
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The Carlson formulation does not treat "consider' parameters. Therefore, 
this formulation has been slightly modified to take non-eatimated uncertain 
model parameters into consideration. Very briefly stated, these modifications 
simply require that the augmented state covariance (including the measurement 
consider parameters) replace the spacecraft’s position and velocity covariance 
in Carlson's algorithm. 

However, the state and state covariance of the measurement consider param- 
eters are not themselves affected. In this way, the uncertainties in the 
measurement consider parameters propagate into the estimation of the space- 
craft's position vector as if the consider parameters were an extension of the 
solution vector, but stopping short of actually computing their corrections. 

The classic Kalman formulation for a measurement update can be written in 
three steps 

P + « P - KGP 


X f « X + K • dy 
K ■ PG T (GPG T + r) -1 


where the (+) supercriptn denote the state or state covariance following the 
measurement update, 

P - P', the augmented state covariance matrix (algorithm NK-2) 

X - State vector (position and velocity, possibly augmented with the 
moon's mean radius) 

K * Kalman gain matrix 

G ■= G', the augmented observation matrix (see algorithm NO-2) 
r * Measurement "noise" covariance matrix 
dy = Observed minus computed measurement discrepancy vector. 


We may express the state covariance matrix as the product of its square- 
root matrix, S, which has the upper triangular form: 

P « SS T 


With which we may write 
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P + . SS T - SS T G T (FPG T + r) -1 GSS T 
- S £ - (S T G T GS)/ot] S T 


8inc« the Spec* S«xt«nt measurement 1* icalar, 

a - (GPG T + r) 

is also scalar , obviating the need for a matrix invars ion. 

Ue obsarv* tost tba square -root of P may b* updated independently 

S f - S [i - ff T /a] ** 


where, as in Carlson's notation, we use f ■ ST cT 

The essence of Carlson's algorithm is the technique for taking the 
square-root of the bracketed quantity which is don* without directy resorting 
to the Cholesky decomposition. 

With each measureiMnt compute the square-root of the augmented state 
covariance which has been integrated up to the time of the measurement 


/F 


where S has the upper triangular form by Cholesky 'a method. Compute the 


column vector f 


,T T 


f - S G 

where the segmented G matrix (see algorithm NO-2) is a (1 x n), 
n ■ « (state variables ♦ 1 ("consider" variables) 


Compute the diagonal elements of the *D and C D matrices: 


°i " a i-l + f l 
a i " (a i-l/ dl > 

C i " f i /(a i-r a i )li / 


i - l,n 

Note that a- a 



n-i+1 


and form the square-root of the matrix 


i-2,n 


A - a 


f* C D 


The updated square-root state covariance matrix is thus 
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from wbicbV fully reconstituted *tate covariance i* computed in temporary 
•torac* , Including tht p*eudo-upd*ted considered parameters, 

P o - s (+) s (+)T 

The tctuel updated state covariance it constructed from only tboee 
element* of P which apply to the real estimation variable*. The remaining 
element* of P+ (1 consider parameter*) being unchanged. 



P , 1 - l,m 

°ij } j - l.n 

p 

o. . } 1 - m+l,n 
J J - 1*« 

P , 1 - mfl.n 
1 j - m+l,n 


The state vector it*elf is updated 


where 


+ 

X 


+ — dy 


S 11 f l + S 12 f 2 •** S lj f j 


b 2 " S 22 f 2 * S 23 f 3 S 2j f j 


l S 


ij S 


1 

j 


l,m 

l,m 


j ’ l,n 
j ■ l.m 
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MAKE MEASUREMENT UPDATE VCLR DESCRIPTION 


Th« following three page* constitute the VCLR for the module. The 
following area and data description* will prove helpful for following 

Area A: 

Cho leaky Decoopoatior. 

Find# the square root of the covariance matrix 
and puta it into a one dimensional array (Reference: 
Carlson, Neal A., "Fast Triangular Formation of 
the Square Root Filter," AIAA Journal) 

Area B: 

Upadate parameters with are specified to be estimated. 
(Reference: Same as for Area A) 

Area C: 

Put single indexed arrays corresponding to square 
roots of the covariance into double dimensional 
arrays. 

Area D: 

Multiply double dimensional arrays to update covariance} 
however, do not update covariance when neither the row 
nor the column element was estimated. 

Definition of data names necessary for understanding of VCLR. 

N ■ Maximum number of considered parameters 
S ■ Single dimensional square root of the covariance matrix 
R ■ Measurement noise variance 
H - Measurement partials array 

IPT ■ Array specifying if parameter is to be estimated 
0» Considered only 
1 * Estimated and considered 
X ■ Array of parameters 

PO ■ Two dimensional square root of covariance matrix 

PT ■ PO trat.spose 

PN ■ New covariance matrix 

DZ ■ Actual-predicted measurament 
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> 

i 

ro 

'-.j 

oo 


00100 
00200 
00300 
00400 
00500 
00600 
00700 
00700 
00700 
00700 
00700 
00700 
00700 
00800 
00900 
01 000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01800 
01900 
02000 
02100 
02200 
02300 
02400 
02500 
02600 
00100 
00200 
00300 
00400 
00500 
00600 
00700 
02700 
00100 
00200 
00300 
00400 
00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 


0001 

0002 

0003 

0004 

0005 


~006 

0007 


0008 

0009 


0010 

0011 

0012 


SUBROUT I NE UPD ATE( N , NS , X . PN , PO , H , R ,DZ . I PT ) 

C DIMENSION X(N ) ,PN( N ,M| .PO(N.N) ,H(N) . IPT(N) 

DIMENSION X( 22 ) , PN I 2 2 . 22 ) , PO ( 22 , 22 ) ■ H( 22 ) , I P T ( 22 ) 
DIMENSION S(2 53 ) . PT< 22,22 / , F(22) ,8(22) 

BEAU *8 A .AL.BT , C . COS REC , D2 .GM,R,T.B,F.H t PN,PO,PT,S t X 
INCLUDE ‘GAIN. COM' 

• C 

• C 

• COMMON /GAIK /GAIN! 22) 

• REAL*B GAIN 

« C 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


THE FORMAL PARAMETERS ARE; 

N LARGEST NUMBER OF CONSIDERED PARAMETERS 

NS NUMUER OF STATE PARAMETERS 

X ARRAYS OF ESTIMATED PARAMETERS 

PN NEW COVARIANCE MATRIX 

PO OLD COVARIANCE MATRIX 

H MEASUREMANT PARTIALS ARRAYS 

R MEASUREMENT NOISE VARIANCE 

DZ ACTUAL - PREDICTED MEASUREMENT DIFFERENCE 

FHIP STATE TRANSITION MATRIX 

I EST ARRAYS SPECIFYING IF A PARAMETER IS TO BE 
ESTIMATED OR CONSIDERED ONLY 


NOTE; PO AND PN ENTER WITH THE SAME VALUES AND PO 
IS DISTROYED BY INTERNAL PROCESSING. 


INCLUDE 'DEBUG.COM 1 

COMMON /DEBU3/ I EN T E R , I DEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

I NTER IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 
IOEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

INCLUDE 'TIME.COM' 

COMMON /TIME/ T IME . T NEXT , T STOP , T I A , DEL , T IN , DTN , DAT EO , TZE RO 

, TMEAS , TRACK , T IS , T 1 SN , DT A , DATER , TPR 1 NT , DTPR INT 
REAL*B TIME,TNEXT,TSTOP.TI A , DE L , T IN , DTN , DATEO , TME AS , TRACK , T I S . 
TISN.DTA.TZERO.DATER.TPRINT.DTPRINT 

THESE ARE THE TIME REFERENCE FRAMES 

TIME ATOMIC TIME SINCE INITIALIZATION (SEC) 

TNEXT TIME FOR NEXT POSITION INTEGRATION (SEC) 

TSTOP RUN TERMINATION TIME (SEC) 

TIA ATTITUDE INTEGRATION TIME (SEC) 

0-L “ * STEP SIZE (SEC) 

TIN POSITION INTEGRATION TIME (SEC) 

DTN " • STEP SIZE (SEC) 

OATEO DATE OF FLIGHT EPOCH (JD) 

OATER DATE OF 1950 EPOCH (JD) 


F 


P«ee 1 


UPOATE 


01800 

01900 

02000 

02100 

02200 

02300 

C2400 

02500 

02600 

02800 

02900 

03000 

OJIOO 

03200 

03300 

03400 

03500 

03600 

03 ’00 0013 

03800 0014 

03900 0015 

04000 0016 

04100 0017 

04200 0018 

04300 

> 04400 0019 

ro 04 500 0020 

04600 0021 

^ 04700 0022 

04800 0023 

04900 0024 

05000 0025 

05100 0026 

05200 0027 

05300 0028 

05400 0029 

05500 0030 

05600 0031 

05700 0032 

05800 0033 

05900 0034 

06000 0035 
06100 0036 

C6200 0037 

06300 0038 

06400 0039 

06500 0040 

06600 004 1 
06700 0042 

06800 0043 
06900 0044 

07000 0045 

07100 0046 

07200 0047 

07300 0048 

07400 0049 

07500 0050 


:• ••• 


• C 

• c 

• c 

• c 

• c 

• c 

• c 

• c 
« c 

c 
c 
c 
c 
c 
c 
c 
c 

o •*« 

10 
20 
21 

122 

'23 

124 

125 
22 


tzero 

tslew 

TIS 

TISN 

OTA 

tprint 

DTPRINT 




_ , * ■ . V/D V 
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B= .» 

time for print (SEC) 

INCREMENT ON TPRINT (SEC) 


. 0-2 
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1 • * ***************4* 

CHOLESKY 0EC0MP0SITI0n****s*I*sq8t*P)******* 


CARLSON SORT FORMULATION 
p * S ST 


60 

70 


CHOLESKY DECOMPOSITION 

•••• ° f ' 

™»»n" 

ro*!?— ' 0T ' li.rw!!-*” ! 

row!??? 0 • or '.'| ;;"««.!!) n.w.k.dz 

• !::r4s:C' A ' 



FOR*!????® 

DO 80 II«1,N 
i - N-n + i 
U « L-1 
00 80 uj«1 , I 

0 * I-dJ-M 
L « L-1 
T « PN(d.I) 

IF ( I . EQ. N) GO TO 70 

LJ • L 

LI - LL 

N1M1 * N-1 

DO 60 K* I , N1 Ml 

Lv) = LJ + K 

LI « L 1 4- K 

J * T "S( L«J)*S( LI) 

IF(L.NE. LL) GO TO 80 

A • 0 • 

IF( T. LE. 0. ) GO TO 80 


Page 




r 


UPDATE 
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_DBAO: [ D 

07600 

0051 


A « 1 . /SORT ( T } 


07700 

0052 

80 

S( L) * T * A 


07800 


C 

COVARIANCE AND STATE UPDATE 


07900 


C 

S+ * SA 


08000 

0053 


L « 0 


08100 

0054 


A l * R 


08200 

0055 


DO 100 I-1.N 


08300 

0056 


T « 0. 


08400 

0057 


DO 90 8*1.1 


08500 

0058 


L * 1+1 


08600 

0059 

90 

T * T+S( L)-H(K ) 


08700 

U060 

100 

n * t 


00800 

0061 


L * 0 


00900 

0062 


DO 110 I * 1 , N 


< »000 

0063 


8(1) * 0 . 


09100 

0064 


er * At 


09200 

0065 


AL = Al+F(I)--2 


09300 

0C66 


GM * SQRT(AL*BT) 


09400 

0067 


A * BT/GM 


09500 

0068 


C » F< I ) /GM 


09600 

0369 


00 110 J = 1 . 1 


09700 

0070 


L * 1+1 


09800 

0071 


T * 5(1) 


09900 

0072 


S( L) * A • T-C* B ( d ) 


10000 

0073 

1 1 0 

B< J) * B(d) + T*F( I ) 


101 00 

0074 


00 120 I *1 ,N 


10200 

0075 


I F ( I PT ( I ) .EQ.O ) GO TO 120 


10300 

0076 


CORREC * B( I ) + DZ/AL 


10400 

0077 


GAIN( I)-B( Il/AL 1 TEMPORARY TO LOOK AT GAIN - JACK 


10500 

0078 


X( I) * X ( I ) + CORREC 


1 060 v 

0079 


I F ( IDE8UG.GT . 1 ) WRITEI6.115) I ,GAIN( I) .CORREC 


10700 

0080 

1 1 5 

FORMAT ( • UPDATE GAIN AND CORRECTION FOR ELEMENT ’,12,' « 


10800 



2E20.10) 


10900 

0081 

120 

CONTINUE 


11000 


C* • 



11100 


c 

TRANSFORM UP P R TRIANGULAR COVARIANCE MATRIX (S) INTO 


11200 


c 

CONVENTIONAL SQUARE MATRIX (PN) 


11300 


o *• 



11400 

0092 


L - 0 


11500 


c* ** 



11600 


c 

PUT SINGLE ARRAY S INTO DOUBLE ARRAYS PO AND PT WHERE 


11700 


c 

PT IS THE TRANSPOSE 


11800 


c • •* 



1 1900 

0083 


DO 160 I “ 1 , N 


12000 

0084 


DO 160 d*1 ,N 


12100 

0085 


IF( J.GT. I ) GO TO 150 


12200 

0086 


L * L+1 


12300 

0087 


PT ( I , J ) * S(L) 


12400 

0088 


GO TO 160 


12500 

0089 

150 

PT(I,d) * 0. 


12600 

0090 

160 

PO(d.l) » PT ( I ,d) 


12700 


o •• 



12800 


c 

MULTIPLY SST TO GET PN , DO NOT UPDATE THE COVARIANCE 


12900 


c 

WHERE THE ROWS AND COLUMNS CROSS 


13000 


c* •• 



131 vJ 

0091 


00 190 1-1. N 


13200 

0092 


DO 180 d-I.N 



V2.0-2 


P«g* 








UPDA * 




moo 

0093 


I F ( IPT< I ).E0 

1 J400 

0094 


T = 0 . 

13500 

0095 


DO 170 K«1 ,N 

1 3600 

0096 

170 

T * T + POU.K 

13700 

0097 


PN(J.I) ■ T 

13B00 

0098 

180 

PN< I , J) . T 

13900 

0099 

190 

CONTINUE 

14000 

0100 


RETURN 

14100 

0101 


END 
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PROGRAM SECTIONS 


Name 


Bytes Attributes 


0 scoot 

1 SPOATA 

2 SLOCAl 

3 GAIN 

4 DEBUG 

5 TIME 


1447 

224 

6456 

176 

8 

136 


PIC CON REL LCL SHR 
PIC CON REL LCL SHR 
PIC CON REL LCL NOSHR 
PIC OVR REL GBL SHR 
PIC OVR REL GBL SHR 
PIC OVR REL GBL SHR 


EXE 

RD 

NQWRT 

LONG 

NOEXE 

RD 

NO MR T 

LONG 

NOEXE 

RD 

WRT 

QUAD 

NOEXE 

RD 

WRT 

LONG 

NOEXE 

RD 

WRT 

LONC 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 UPDATE 


VARIABLES 


Address 

Type 

Name 

Address 

Type 

Name 

2-00001868 

R»8 

A 

2-00001 870 

R *8 

al 

2-00001888 

R*8 

CORREC 

5-00000038 

R *8 

DaTEO 

S-00000068 

R*8 

DT A 

5-00000030 

R * 8 

DTN 

2-00 00 1890 

R*8 

GM 

2-00001 8A0 

I *4 

I 

2-0000 I8AC 

1*4 

I I 

2 -0000 1 8 A4 

I *4 

J 

2-00 00 1 8A8 

1*4 

L 

2-00001 BBC 

I *4 

LI 

AP-00000004# 

1*4 

N 

2-00001 8C0 

I *4 

N 1 Ml 

2-00001898 

R*8 

T 

5-00000018 

R*a 

T I A 

5-00000058 

R*8 

TIS 

5-00000060 

R *8 

T I SN 

5-00000078 

R*B 

tprint 

5-00000050 

R*8 

TRACK 


Address Type Name 


2-00001878 

5-00000070 

5-00000080 

4- 00000004 
2—00 00 1 8B4 
2-00 001 8B8 

A P-0000 00080 

5- 00000000 
5-00000048 
5-00000010 


R-8 8T 
R* 8 DATER 
R*8 DTPRINT 
1*4 IDEBUG 
1*4 JJ 
I»4 LJ 
1*4 NS 
R*8 TIME 
R*8 TMEAS 
R*8 TSTOP 


ARRAYS 


Address Type Name 


2-00001080 

5-00000020 

AP-00000020* 

4- 00000000 
2-00001 8C4 
2-COOO 1 8B0 

AP-0000001CM 

5- 00000028 
5-00000008 
5-00000040 


R * 8 C 
R *8 DEL 
R * 8 DZ 
1*4 1 ENTER 

I *4 K 
1-4 LL 
R*a R 
R * 8 TIN 
R*8 TN EXT 
R*8 TZERO 


Address Type 

Name 

Bytes 

Dimension* 

2-0000 1788 R»8 

8 

1 76 

( 22 ) 

2-00001708 R*C 

F 

1 76 

(22) 

3—00 000000 R*8 

GAIN 

1 76 

(22) 

AP-00 0000 188 R»8 

H 

1 76 

(22) 

AP— 00 00('02<«i I»4 

IPT 

88 

(22) 
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7- Jan-1981 


15:04:05 

18:03:21 


A P—00 00001 OP 

R»8 

PN 

3872 

(22. 

22) 

A P—00 0000 14# 

R*e 

PO 

3872 

(22. 

22) 

2-000007E8 

R*e 

FT 

3872 

(22, 

22) 

2— OOoOOOOO 

R*e 

S 

2024 

(2S3) 

AP-OOOOOOOC* 

R*8 

X 

1 76 

(22) 



LABELS 


Address 

Labe 1 

Address 

Label 

Address 

Label 

Address 

Label 

Address 

label 

Address 

Label 

1-00000000 

0- 00000300 

1- 0000006A 

• * 

10' 

80 

122' 

170 

1-0000001 A 
* * 

1-00000075 
* * 

20' 

90 

123' 

180 

1-00000035 
• • 

1-00000080 

0-000005BD 

21 ' 
100 
124' 
190 

1-00000095 
• * 

1-0000008B 

22' 

no 

125' 

• • 

1 — 000000A5 
0-000004D6 

60 
1 15' 
150 

0- 000002 E4 
0-00000490 
0-0 00004 E3 

70 

120 

160 


FUNCTIONS ANO SUBROUTINES REFERENCED 
MTHSOSQRT 

Total Space Allocated * 8447 Bytaa 
COMMANO QUALIFIERS 

FORTRAN /LIST GC P , INOAT A .MAT A0 .OUT DATA , RUNG.DNAV .EPHEM.TRUEA.SPRESS ■ OCCULT ,GPERT , GCPSEQ. VISIBLE , GENENV, TREG. GV ROUT .RATE. BMAT ,CMA 
/CHECK*! NO BOUNDS .OVERFLOW) 

/F77 /NOG FLOATING /I4 /OPTIMIZE /WARNINGS /NOD_LINES /NOMACHINE_CODE /C0NTINUATI0NS“19 


COMPILATION STATISTICS 

Run Time: 4.71 seconds 

Elapsed Time: 86.74 seconds 

Page Faults: 386 

Dynamic Memory: 160 pages 


2.8.0 PRINT PKRFORMACE DATA (OOTDATA) 

The purpose of this module is to prepare and print output data pertaining 
to each attitude and navigation time and measurement update. 

The Print Performance Module is straightforward as described in the VCLR 
shown in Figure A-44 . Kbwever, one portion which needs explanation, is 

the section involving the T44 transformation matrix. This is explained below. 

The error in the quaternion is found through the equation: 

* 

e • R • F 

where 

e ■ error in the quaternion 

R * real world quaternion 

F ■ filter (or predicted) quaternion 

This corresponds intuitively to "subtracting" the predicted values of the 

quaternion from the real world values.)’ 

The covariance matrix associated with the error quaternion is 
calculated by 

- N M M 1 


where P^ "uncertainty in rotation about each axis 
T44 - transition matrix 

Pp “ filter covariance 

The T44 matrix is found by taking the partials of e with respect to each 
component of the real world quaternion. 


1 An alternate equation, e ■ F* R could have been used. However, this 
equation is slightly leas intuitive and was not chosen for this reason. It 
should be noted that these two equations yield slightly different results due 
to the fact that quaternion multiplication is not commit it ive. 


A-283 



It should be noted that 

e “ R • F* = T . . R 

+4 


Therefore, T44 can be used both to find the uncertainty in the rotation 
about each axis ( P ) and the error in the actual vs predicted value of the 
quaternion. 


Next, the uncertainty in the error quaternion e is transformed to an 
uncertainty about each axis as follows: 


'o 

0 

0 

2 


’o 

0 

0 

0 

0 

2 

0 

p 

0 

0 

2 



£ 




_0 

2 

0 

0 _ 


2 

0 

o 


44 

Pe 43 

Pe 42 

34 

?e 33 

p r 32 

24 

Pe 23 

?e 22 


The standard deviations of the uncertainty about each axis are the square 
roots of the appropriate diagonal elements of the P matrix. The RSS of these 
standard deviations is both printed and plotted. 
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OUTDATA VCLR 


POST -FLIGHT OPERATION 


INITIALIZE REAL WORLD QUATERNIANS 


DETERMINE REAL WORLD POSITION AND VELOCITY 


TIME FOR PRINT 


INCREMENT PRINT TIME 


PRINT HEADER, MEASUREMENT TYPE, ACTUAL AND FILTER STATES 


COMPUTE T 44 


COMPUTE ERROR STATE 


PRINT ERROR STATE 



PRINT EARTH, MOON, AND STAR VECTORS 


MEASUREMENT FOR ATTITUDE REFERENCE 


COMPUTE AND PRINT NAV. STANDARD DEV. 


COMPUTE AND PRINT ATTITUDE STANDARD DEVIATION 


PRINT STATE COVARIANCE 


PRINT ERROR PARAMETERS 


PRINT STATE TRANSITION MATRIX 


WRITE PLOT FTLE 
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> 

i 


00100 

00C1 


00200 


c 

00300 


c 

00403 


c 

01SC0 


c 

00600 


c 

0u700 


c 

C0803 

oooa 


00100 

0003 

• 

00200 


• c 

00300 


* c 

00400 


- c 

00500 


• c 

00600 


< c 

00700 


• c 

00900 

004 


OlwOO 


• c 

01000 


• c 

01000 


• c 

01000 


• c 

01000 


• c 

oiooo 


• c 

01000 


• c 

OIOOO 

0005 

• 

01000 


* 

OIOOO 

0006 

• 

OIOOO 


• c 

OIOOO 

00 n 7 


01100 

0008 

• 

01*00 

0009 

• 

01100 


• c 

01100 


• c 

01100 


• c 

01100 


• 

01 100 


• 

01100 


• 

01100 


• 

01100 


• 

01100 


• 

01100 

00 1 


01200 

001 1 

• 

01 POO 


• 

01200 

0012 

• 

01200 


• 

01200 


• 

0 1 2b0 


• 

01200 


• 

01200 


• 

01200 


• 

01200 


• 

01200 


• 

01200 


• 

01200 


• 

01300 


• 

01200 


• 

01200 


• 

01200 


• 


SUBROUTINE OUTDATAUCAIL) 

FORMAL parameters 

ICALL » OUTPUT PRINT INDICATOR T 

0 INDICATES called after a measurement 

1 INOICATES CALLED AFTER PROPAGATION 

INCLUDE 'OEBUG.COM' 

COMMON /OCBUG/ I EN T E R . I OE BUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 


I NTER 
I DEBUG 

INCLUDE 'RES10UALS COM* 


IF 1 PRINTS MHEN ENTERS MOST SUBROUTINES 
0-1 o'. HIGHER NUMBER MEANS MORE PRINT 


COM CONTAIN} THE RESIOUALS VALUES FOR THE GPS. 
landmark TRACKER. AND star TRACKER MEASUREMENTS 


COMMON /RESIDUALS/OZHLM, DZVLM , OZMST 1 .02VST 1 .02HST2.DZVST2. 

REAL*B OZHLM.OZVLM?o2MSTt?0ZVST1.O2MSTa.O2VST2.OXMGPS 

INCLUDE 'CONTPL.COM' 

COMMON /CONTRL/ MOP. TINT 
REAL*# TINT 


PROGRAM CONTROL DESCRIPTORS FOR MULTIPLE RUNS 
MOP 


TINT 


MODE OF OPERATION 
1 - PREFLIGHT SIMULATION 

3 « POSTFLIGHT SIMULATION 
3 « MONTE CARLO SIMULATION _ w _. 

NUMBER OF SECONDS OF FULL OPERATION PER CYCLE 


,9t . 52 .R3 . RSMA , RTG(3) 

" re AL*S R,RM,R0.RSK.RS0.RSS,SB.RA.Ra.R3,RSMA. 0 


THESE ARE RAOIUS VECTORS IN ECI ANO BOOT COORDINATES 
EART 


R 

RM 

RO 

PSM 

nso 

R5S 

RA 

Ra 

R3 

RSMA 


NTER TO S/C - ECI (KM) 

• MOON - ECI (KM) 

. • SUN - ECI (KM) 

SPACECRAFT TO MOON - EC I‘ K ?Lv 

- SUN - ECI (KM) 

EARTH CENTER TO STAR - ECI 

ABSOLUTE OF VECTOR R (KM) 

SQUARE OF RA (KM 2) 

CUBE OF RA (KM 3) 

ABSOLUTE OF RSM (KM) 


■■ 


Page 




OUTOATa 


01200 

0013 



01300 

0014 



01300 

C01S 



01300 



C 

01300 



C 

01300 



c 

01300 



c 

01300 



c 

01300 



c 

0i?00 



c 

01300 

01390 

0016 


■c 

01400 



c 

01400 

0017 



01400 

001 S 



01400 



c 

01400 



c 

01400 



c 

01400 



c 

01400 



c 

01400 



c 

01490 



c 

01400 



c 

01400 



- 

01400 

01400 

0019 


V 

01500 

0020 



01500 

0021 



01500 

0022 



01500 



c 

01500 



c 

01500 



c 

01500 



c 

01500 



c 

01500 



c 

01500 



c 

01500 



c 

01500 
Cl 500 

0023 


c 

01600 



c 

0I6CJ 

0024 



01600 

802S 



01 too 



c 

“1600 



c 

t • oOO 



c 

til 600 



c 

01600 



c 

01600 



c 

01600 



c 

oieoo 



c 

01600 

01600 

0026 


c 

00100 

00200 

0027 



00300 

0026 



00400 



c 

00500 



c 


10-Apr-l 981 1 1 :4B: 30 VAX-11 FORTRAN V2.0-2 
IO-Apr-1981 1 1 : 46:57 _06AO: (01 1R.GCP]OUTDATA. FOR; 54 

include 'envir .cg.*’ 

COMMON /ENVIR/ STATE ( ' 0 ) , PROF I LE ( 10.4) , INIT 
REAL'S STATE. PROFILE 

REAL WORLD STATE PARAMETERS 

STATE state VALUES; X.V.Z.XO.VD.ZD.EO.E1.E2.E3 

PROFILE ATTITUDE PROFILE-TIME (SEC) VS 

INERTIAL ANGULAR NATES (RAD/SEC) 

INI T INTEGRATION INITIALIZATION KEY (-1) 

INC! UDE 'ASTATE.COM' 

COMMON /ASTATE/ OE I A ) . E ( A I . WOO ) , SF(3 1 , 3( 3 ) , D0( 3 ) 

REAL'S OE.E.WD.SF.0,00 

ATTITUOE STATE ANO CONSIDERED PARAMETERS 


0 diferential of quaternions 

k QUATERNIONS 

WD GYRO DRIFT RATE (RAD/SEC) 

SF GYRO SCALE FACTOR 

D GYRO NON-ORTHOGANALITV (RAD) 

DO GYPO RELATIVE ORIENTATION (RAO) 

INC'UOE ’TARGETS.COM' 

COMMON /TARGETS/ MT YPE , I S , NS , JFL AG.MCOQE , PI , TPI 
LOGICAL JFLAG 
REAL'S PI, TPI 

MEASUR.MENT SPECIFICATIONS 

MTYPE MEASUREMENT TYPE 

U c lAG SET FCR STAR OBSTRUCTION 

MCOOE • • MEASUREMENT PROCESSING 

PI PI 

TPI 2'PI 

Include 'nstate.com' 

COMMON /NSTAT2 / ; X( 6) , RAOM, RAOE 

REAL'S XD.X.RtOV . f f.(iL 

POSIT M STATE ANO CONSIDERED PARAMETERS 

XO STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 

X STATE POSITION PARAMETER* (KM AND KM/SEC) 

RADM RAO I US OF THE MOON (KM) 

RADE EARTH OE iTCTABLE RADIUS (KM) 


INCLUDE 'PHU.COM' 

COMMON /PHIA/ PA( A .4 ) , T A( 4 , 1 2) , PDA( 4 , IS). PHI A ( 1 6 ■ 1 6 ) , 

. C0VA( 16,131 ,POA(16, 16). DMA* 

REAL'S PA.TA.POA.PHI A.COVA.POA.QMAX 

THESE ARE THE ATTI/UOL TRANSITION ANO 'OVARIANCE MATRICES 


.. . . , . _ ... . . w . -. . MtiMatlM I m 


Pmgm 


outoata 


0 

I 

-c 


> 

I 

ho 

CO 

vO 


00600 

00700 

ooeoo 

00900 
01000 
01100 
01200 
01300 
01400 
01700 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01800 
01900 
01900 
01900 
01900 
01 900 
01900 
01900 
01900 
01900 
01900 
01900 
01900 
00 100 
00200 . 
00300 
00400 
00500 
00600 
00700 
00800 
00900 
01 000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
31800 
01900 
02000 
02100 
02200 


0029 

0030 

0031 


0032 

0033 

0034 


0035 

0036 

0037 


C 

C 

C 

C 

C 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 
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PA 

ATTITUDE 

STATE TRANSITION MATRIX 

TA 

M 

PARAMETER TRANSITION MATRIX 

PDA 

m 

DERIVATIVE OF TRANSITION MATRICES 

PHIA 

m 

AGGREGATE TRANSITION MATRIX 

COVA 

N 

NEW COVARIANCE MATRIX 

POA 

m 

PREVIOUS COVARIANCE MATRIX 

QMAX 

« 

COVARIANCE NORM MAX 


include •phin.com' 

COMMON /PHIN/ PN ( 6 . 6 ) , PDN{ 6,6),PHIN(6,6), C0VN(6, 6 ) 

PON( 6 , 6 ) 

REAL’S PN.PDN, PHIN. COVN, PON 

THESE ARE THE NAVIGATION TRANSITION AND COVARIANCE ARRAYS 


PN 

POSITION 

PDN 

M 

PHIN 

II 

COVN 

M 

PON 

N 

INCLUDE 'ARRAYS.COM' 



STATE TRANSITION MATRIX 
DERIVATIVE OF TRANSITION MATRIX 
AGGREGATE TRANSITION MATRIX 
NEW COVARIANCE MATRIX 
PREVIOUS COVARIANCE MATRIX 


COMMON /ARRAYS/ T1 ( 3 ) , T2( 3 ) , T3( 3 ) , T4( 1 0) . T1 1 ( 3 .3) , T33( 3 , 3 ) 

* • T44 (4.4), T66 (6,6),T77(G,6)iT5(4),T6(4),T7(4) 

REAL’S T1 .T2.T3.T4.T1 1 ,T33,T44.T66.T77,T5,T6,T7 


THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 

T 1 " T 4 SINGLE DIMENSION ARRAYS 

Til - T77 DUAL DIMENSIONED ARRAYS 
T1 I DUAL ARRAY; OFF D I AGIONA L SET TO ZERO 

INCLUDE 'TIME.COM' 


COMMON /TIME/ T IME , T NEXT , T STOP . T I A , DE L , T IN , D TN . DAT EO . TZE RO 

• , TME AS, TRACK, TIS, T I SN , DT A , DATE R , T PR I NT , DT P R J NT 
REAL’S TIME.TNEXT, TSIOP, TI A.DEL. TIN.DTN.OATEO, TMEAS .TRACK TIS 

• TISN.DTA.TZERO.OATER.TPRINT.DTPRINT 


THESE ARE THE TIME REFERENCE FRAMES 


TIME 

TNEXT 

TST0P 

TIA 

D . L 

TIN 

0TN 

OATEO 

DATER 

TZER0 

TSLEW 

TIS 

T I SN 

DTA 


ATOMIC TIME SINCE INITIALIZATION (SEC) 

TIME FOR NEXT POSITION INTEGRATION (SEC) 
RUN TERMINATION TIME (SEC) 

ATTITUDE INTEGRATION TIME (SEC) 

” " STEP SIZE (SEC) 

POSITION INTEGRATION TIME (SEC) 

STEP SIZE (SEC) 

DATE OF FLIGHT EPOCH (UD) 

DATE OF 1950 EPOCH (UD) 

START TIME IN SECS. SINCE DATEO 
TIME NEEDED TO SLEW AND ACQUIRE (SEC) 

REAL WORLD REFERENCE TIME (SEC) 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 
USUALLY ♦ DEL BUT ♦ TSLEW - TIA WHEN DEL 
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> 

I 

KJ 

nO 

o 


i'uro»fA 


02300 


• C 

02400 


• c 

02500 


* c 

02600 


• c 

C 2000 

0038 


02100 


• c 

02100 

0039 

• 

02100 

0040 

• 

02100 


• c 

02100 


* c 

02100 


• c 

02100 


* c 

02100 


• c 

02100 


* c 

02100 


• c 

02100 


• c 

02100 

0041 


02200 


* c 

02200 

0042 

• 

02200 

0043 

• 

02200 


* c 

02200 


* c 

02 '00 


• c 

02200 


• c 

02200 


* c 

02200 


• c 

02200 

0044 


02300 

0045 

* 

02300 


• 

02300 

0046 

• 

02300 


• c 

02300 


* c 

02300 


• c 

02300 


♦ c 

02300 


• c 

02300 


* c 

02300 


* c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 


• c 

02300 

0047 


00100 

0048 

• 

00200 

0049 

• 

00300 


• c 

00400 


• c 

00500 


• c 

00600 


• c 

02400 

0050 


00100 

00S1 

• 

00200 


* 

00300 

0052 

• 

00400 


• 

00500 


* c 

00600 


• c 

00700 


• c 
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'CO LARGE AT MEASUREMENT TIME 
TPPINT TIME FOR PRINT (SEC) 

DToRiNT INCREMENT ON TPRINT (SEC) 

INCLUDE 'UPDT.COM' 

COMMON /UPDT / ON ( 6 ) . 0 A ( 1 6 ) ,0(6 , 6 ) ,QOOT ( 6 ,6) 

REAL'S QN.OA.Q.QDOT 

STATE STIMAT.ON PARAMETERS 

ON 
QA 
0 

000 T 

INCLUDE 'PLOT.COM' 

COMMON /PLOT/ TPI.TP2 
REAL'S T P ' , TP2 

PLOTING INFORMATION 

TP1 LOWER ABSCISSA VALUE - TIME (MIN) 

TP2 UPPER * * 


NAV. OYN • NOISE COVARIANCE DIAGONAL 
MIN. VALUES FOR ATT. COVARIANCE DIAGONAL 
CONTRIBUTION TO NAV. COV . FOR OYN. NOISE 
DIFFERENTIAL OF 0 


SoS E /CoSpSs^/ ' PH U 22 . 22 ) . QT ( 22 . 22 > .COV ( 22 . 22 ) . P0( 22 . 22 ) 
I P( 2 2 ) ,XT( 22) ,P< 22,22) 

REAL'S PHI ,QT ,COV , PO.XT , P 


PHI 

OT 

COV 

PO 

IP 

XT 

P 


. COMPOS IT STATE TRANSITION MATRIX 
, •• PROCESS NOISE ARRAY 

* NEWEST COVARIANCE ARRAY 

* OLD COVARIANCE ARRAY 

= ARRAY OF FLAGS INDICATING ESTIMATED AND 
CONSIDERED PARAMETERS 
= COMPOSIT ESTIMATED PLUS CONSIDERED 
STATE VECTOR 

. initialized transition matrix for next 

INTREVAL 


INCLUDE 'TITL.COM' 

COMMON /TITLE/ AT I T LE ( 40 ) 
LOGICAL" ATITLE 


ATITL IS THE TITLE PRINTED AT EACH PRINT TIME 
AS NELL AS THE TOP OF EACH PLOT 


COMMON ^/IMTPAR/ 'al > ?cOH.LAT,TBNL(3.31.TNL(1.3).BI(I),SI.(3). 

CSS:5t!K:rJS:ai:aKSa4!{SSOT.u-. 

THET 


• V) A T A . F G * 


‘xs c* 
<*> f- 

s: > 

h< O 

a« 


LANDMARK TRACKER PARAMETERS 


■' ■ , .. ■««•.. ‘ i... ... Lj.,;.- jL . ■ - ■■i.i'itij- UK b'tK,: : ’ ■ .. i:.-.. ^.'ij ... j , 


Pa-i 




OUTDAT* 


00800 

00900 

01000 

01100 

01200 

01300 

01400 

01500 

01600 

01700 

01800 

01900 

02000 

02100 

02200 

02300 

02400 

02500 

02500 

02600 

02700 

02800 

02900 

03000 

03100 

03200 

03300 

03400 

03500 


0053 

0054 

0055 

0056 

0057 


• •• 
• •• 


lO-App-tgei 1 i 148:20 
1 0 -Apr-1 981 1 1 : 46 : 57 

AL * 4U1TUOE or LANDMARK (KM; 

LON * LONGITUDE or LANDMARK (DEG; 

LAT « LATITL.DE Or LANOMAP* (DEG; 

TBNL * OR .ENT AT ION ARP Ay FOR LANDMARK TRACKER 
NOMINAL TO SOOT 

TNL « MISALIGNMENT ARRAY - ACfjAL 

TRACKER TO NOMINAL 
BL * BIAS - ACTUAL (RAO) 

SL * NO.SE STANDARD DEVIATION - ACTUAL (RAO) 

BKL » BIAS - KNOWLEDGE (RAO) 

TMET * LOOK ANGLE (RAO) 

SKL « NOISE STANDARO DEVIATION -KNOWLEDGE (RAD) 
TIEO * INITIAL EARTH FIXED TO INERTIAL 
TRANSFORMATION 

TNLK « MISALIGNMENT ARRAY KNOWLEDGE 

TRACKER TO NOMINAL 

S1GGCP * POSITION UNCERTAINTY DUE TO ClOUOS 

ICALL * 1 TIME UPOATE 

1CALL >0 M ASUREMENT UPOATE 


VAX-11 FORTRAN V2.0-2 

_DBAOT [01 1R.GCPJ0UT0ATA. FOR; 54 


DIMENSION T44T (4,4 ) .PATT(4.4),PAT{4,4) 

DIMENSION AT ( 3 , 3 ) , ST ( 4 ) 

01 MENS! ON DSTAT ( 10 i 

REAL*8 DELTAT , DZ.EATT ,PATTF .PNAvF.PTIME, TMLAST . TPUNCH. AT , OSTAT E , 
PAT.PATT.ST.T44T.ENAV 
DATA TMLAST /O./ 

C CALL AEROSPACE ROUTINE TO GET REAL WORLD ATTITUDE (TEMPORARY) 


UJbUO 

03700 

0058 

c* 

IF (M0P.NE.2) GO TO 10 

03800 

0059 


STATE( 7) - ST ( 4 ) 

03900 

0060 


ST ATE ( 8 ) . ST< 1 ) 

04000 

0061 


ST ATE( 9 ) . ST{ 2) 

04100 

0062 


STATEOO) • ST ( 3 ) 

04200 

0063 


IF (TIME .GT. .00001 ( GO TO 13 

04300 

0064 


IN I T 1 »- 1 

04400 

0065 


GO TO 10 

04500 


C» 


04600 


C DETERMINE real world position ano velocity 

04700 


c* ••• 


04800 

0066 

13 

DELTAT . TIME - TMLAST 

04900 

0067 


IF (DELTAT. LT. .00001 > GO TO 10 

05000 

0068 


CALL RUNG( INIT 1 . STATE, OST A TE . TMLAST . OELTAT ) 

05100 

0069 


TMLAST * TIME 

05200 

0070 

10 

IFITIME .LT. TPRINT; GO TO 220 

05300 

0071 


WRITE! 6,5) ( ATITLE( I ) .1*1 ,40) 

05400 

0072 

5 

FORMAT ( 1H1 ,//,4X .40A1 ) 

05500 

0073 


WRITEI6. 14) TIM 

05600 

0074 

14 

FORMAT ( / / , 5X , 7HT I ME « ,F9.3j 

05700 

0075 


GO TO ( 1 50 , 160 , 170 , 1 00) .MCOOE 

05800 

0076 


WRITE<6. 145) 

05900 

0077 


GO TO 15 

06000 

0078 

145 

FORMAT { / , 5X , 1 4HN0 MEASUREMENT) 

06100 

0079 

150 

WR ITE( 6 , 155) 

06200 

0080 


WRITE( 6, 1 155 ) TMET 

06300 

0081 

1155 

FORMAT ( /,5X, * LOOK ANGLE • ’.E15.7) 
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OUTOATA 
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_DBAO: 

[D1 1R.GCP] OUTOAT A. FOR; 54 

06400 

0082 


WRITE! 6, 1 156 ) LON , LAT , AL 



06500 

0083 

1 1 56 

FORMAT (/,5X, ' LON. LAT ,AL « 1 , 3 ( 3X , E 1 5 • 7 ) ) 



06600 

0084 


GO TO 15 



06700 

0085 

155 

FORMAT!/ .5X.44HLANDMARK TRACKER MEASUREMENTS HAVE BEEN MAOE) 



06800 

0086 

160 

NP ITE<6, 165) 



06900 

0087 


GO TO 15 



07000 

0088 

165 

FORMAT!/ .5X.3IHGP5 MEASUREMENTS HAVE BEEN MADE) 



07100 

0089 

170 

NR I TE ! 6 . 175) 



07200 

0090 


GO TO 15 



07300 

0091 

175 

FORMAT!/ ,5X, 41 HSTARTPACKER 1 MEASUREMENTS HAVE BEEN MADE) 



07400 

0092 

180 

WRITE(6. 1 85 ) 



07500 

0093 

185 

FORMAT!/ ,5X. 41 HSTARTRACKER 2 MEASUREMENTS HAVE BEEN MADE) 



07600 

0094 

15 

NR I T E ( 6 , 18) STATE. X.E 



07700 

0095 

18 

FORMAT ( / /5X , 50HACTU A L/FI LT ER STATES — * , V , Z . XD, YO , ZD, EO . E 1 . E2 , E3 



07800 



. /212X.3E14.7. 7 12.4/)) 



07900 

0096 

22 0 

continue 



08000 

0097 


T44 ( 1.1) ■ STAT (7) 



08100 

0098 


T44 ( 2 , 2 ) • STAT. (7) 



08200 

0099 


T44 ( 3 , 3 ) * STAT (7) 



08300 

0100 


T44 ( 4 . 4 ) ■ STAT .1 7) 



08400 

0101 


T44 t 2. 1 ) « -ST ATE! 8 ) 



08500 

0102 


T44( 3 , 4 ) ■ “ST ATE ( 8 ) 



08600 

0103 


T44 ( 1.2) « STAT |8) 



087C0 

0104 


T44 ( 4 , 3 ) « STAT (8) 



08800 

0105 


T44( 3. 1 ) « “ET ATE ( 9 ) 



08900 

0106 


T44I4.2) « “ST ATE < 9 ) 



09000 

0107 


T44( 1.3) » STAT (9) 



09100 

0108 


T44 ( 2,4) « STAT. (9) 



09200 

0109 


T44 ( 4 , 1 ) » “STATE! 10) 



09300 

0110 


T44( 2.3) « -STATE! 10 ) 



09400 

or; . 


T44 ( 1,4) « STAT (10) 



09500 

0112 


T44( 3 , 2 ) « STAT (10) 



09500 


c* 



• 

09700 


C PERFORM QUATERNION MULTIPLY 



09800 


C EPS 

• (FILTERQUATERN ION) •( RE A LWORLDQUA TERNIONSTAR ) 



09900 


c* ••• 



• 

10000 

0113 


CALL MATAB1T44, . . T4( 7 ) ,4,4 . 1 ) 



10100 


c* ••• 



• 

10200 


c 

MTYPE - 1 FOR NAVIGATION 



10300 


c 

2 FOR ATTITUOE REFERENCE 



10400 


c 

3 for calibration 



10500 


c 

4 FOR CRUISE FLIGHT 



10600 


o ••* 



• 

10700 

0114 


DO 20 1*1,6 



10800 

0115 

20 

T4 ( I ) * STATE! I ) -X f I ) 



10900 

0116 


I F ( T I ME .LT. TPR1NT) GO TO 120 



11000 

0117 


TPRINT *TPRINT+DTPRINT 



11100 

0118 

30 

NR I TE ( 6 , 40 ) T4 



11200 

0119 

40 

FORMAT { 5X , 1 8HS TATE ERROR VECT0R/2X , 3E1 4 . 7 , 7E 1 2 .4 , / ) 



11300 


c* *• * 


» 


11400 


c 

NRITE OUT data FOR PLOTTING ROUTINES 



11500 


c* * •* 


» 


11600 

0120 


IFUCALL.EQ.O) WRITE(6,115) RM, RO, RSS 



11700 

0121 

115 

FORMAT (4X , ' EARTH TO MOON ' , 7X . 3E22 . 14 , / ,4X , 



11800 



. ' EARTH TO SUN 1 , 7X , 3E22 . 14 , / , 4X , 



11900 



. ' UNIT VECTOR TO STAR '.3E22.14) 



12000 

0122 


IF (MTYPE.EQ.2 . ANO. 1 CALL . EQ. 0) GO TO 70 
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ootoata 

12100 

01 23 
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PNAVF* SORT ( COV (1,1 ) +C0V (2,2)+C0V(3,3)) 

12200 

0124 


DO 50 1*1,3 

12300 

0125 

50 

TKI) * SORT ( C0V ( I . I) ) 

12400 

01 26 


WR 1 TE( 6 , 60 ) TXN.TI.PNAVF 

12500 

0127 

60 

FORMAT! / .5X.29HNAV1GAU0N STANOARO DEV 1 ATJON , F7. 0 , 4E 16. 6 ) 

12600 

0126 


EN AY * SCRT( T4< 1 ).»2*T4( 2) • • 2* T4 ( 3 ) • • 2 ) 

12700 

0129 


IF (MTyPE.EQ.1 .ANO. ICAIL-EQ.O) GO TO 120 

12800 

0130 

70 

DO 80 1*1,4 

12900 

0131 


DO 80 d* 1 ,4 

13000 

0132 


T44T1 I ,d) . T44(d, I I 

13100 

0133 

80 

PATT ( 1 ,6 ) . COVA! I , J ) 

13200 

0134 


CALL MAT ABtPATT , T44T .PAT ,4 ,4 ,4) 

13300 

0135 


CALL MAT AB( T44 , PAT ,PATT ,4 , 4.4) 

13400 

0136 


PATTF « 2 . *SOR T(PATT(2,2)*PATT(3,3)4PATT(4,4)) 

13500 

0137 


DO 90 1.2,4 

13600 

0138 

90 

PATTU.l) . 2. "SORT! PATTU , I) ) 

13700 

0139 


WRITE (6. 100) T 1A. ( PATT( I. 1 ) , I .2 , 4 ) , PATTF 

13800 

C 1 40 

100 

FORMAT! /5X.27H TTITuDE STANOARO DEVIATION, F7.0.4E, - 6.6/ 

13900 

0141 


WRITEI6. 992) 

14000 

0142 

992 

FORMAT! ///4X, ' STATE COVARIANCE ') 

14100 

0143 


170 105 I • 1.22 

14200 

0144 


II * I 

14300 

0145 


IF < I .GT.8) II . 8 

14400 

0146 


WRI TE ( 6, 1 03 ) (COV(I.J), J.1,11) 

14500 

014? 

103 

FORMA T(5X,8E15.8) 

14600 

0148 

105 

CONT 1 NUE 

14700 

0149 


WRITE16, 106) 

14800 

0150 

106 

FORMAT! 1 HI ,/5X , ' (CONTINUED) ‘ ) 

14900 

0151 


DO 107 1 . 9,22 

15000 

0152 


1 1 = I 

15100 

0153 


IF(I.GT.16) 11*16 

15200 

0154 

107 

WR I TE ( 6 , 1 03 ) <COV( I.J), d>9. II ) 

15300 

0155 


WRITE! 6, 108) 

15400 

0156 

108 

FORMA T ( /5X , ’ (CONTINUED) * ) 

15500 

0157 


DO 109 1*17, 22 

15600 

0158 

109 

WRITE(6, 1 03) ! COV ( I . J ) , d»17, I ) 

15700 

0159 


WRITEI6.110) ( £( I ) . 1 =1 ,16) 

15800 

0160 

1 1 0 

FORMAT (/ /5X. 19HATT I TUDE P ARAMET ERS/5X . 1 1 HQUATEIiNIONS ,9X . 4E 1 6 

15900 



.5X.10HGYR0 DHI FT.10X .3E16. 9/5X , 1 7HGYR0 SCALE FACTO R , 3X , 3 E 1 6 . ! 

16000 

16100 

16200 

0161 


.5X.20HGVR0 NON -ORTHOGONAL , 3E1 6 . 9/5X, 20HRELAT IVE ORIENTATION 
.3E16.9) 

EATT * 2 .‘SORT ( T4(0) • • 2+T4 ( 9 ) • *2 +T4( 1 0 ) »*2 ) 

16300 

0162 


WRITE (6,111 > 

16400 

016", 

11 1 

FORMAT (//5X. ' STATE TRANSITION MATRIX *) 

16500 

016* 


DO 112 1 • 1.10 

16600 

0165 


1 1 - 1 

16700 

0166 


IF( I. GT.8) 11-9 

16800 

0167 

1 1 2 

WRITE(6,103)( PH I(l,J),v!*1,II) 

16900 

0168 


WRITE! 6,108) 

17000 

0169 


DO 113 1*9,10 ! JACK-2/21/81 

17100 

0170 


II*I 

17200 

0171 


IF,: GT. 10| 11*10 ! d ACK-2/2 1/81 

17300 

0172 

113 

WR I T t : 4 , 1 « - (PHI ( I ,d) , d*9, 1 1 ) 

17400 


C* •••< 


17500 


c 

CREATE formatted FILE LISTING TIME, MEASUREMENT TYPE JUST 

17600 


c 

ESTIMATE OF QUATERNION, DIFFERENCE BETWEEN MEASUREMENT AND 

1770* 


c 

MEASUREMENT. ESTIMATE OF POSITION AND VELOCITY AT CERTAIN 
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1780C 


c* •• 


17900 

18000 

18100 

18200 

0173 

120 

MR I TE ( 12, 45 ) TIME, T4, < SQR T (COV < dl ,J1 ) ) ,J1 *1 ,6) , 

• (PATTIJ1 ,J1 > , J 1 = 1 ,4). 

• DZHLM.DZVlM.DZHSTI .DZvSTI , DZHST2,D2VST2 , DXMGPS , 

« (STAT (dl ) . J1*1 .6) 

18300 

0174 

45 

FORMAT (39F20 .10) 

18400 

0175 


IF< ICALU .rO. 1 ) GO TO 130 

18500 

0176 


PTIME * TIA 

18600 

0177 


IF (MTYPE.EQ.1) P r i-c * TIN 

18700 

0178 


IFfPTIME.LT.T PUNCH) GO TO 130 

18800 


C 

WR 1 TE ( 1 1 ,1 25 ) PTIME, MTYPE.MSET, 

18900 


C 

. ( E ( I ) , I • 1 , 4 ) , OZ.IX(l), 1*1,6) 

19000 

19100 

0179 

125 

FORMAT ( 1 X.F10. 1 , 1 X . 2 ( I 2 . 1 X ) ,4( F 1 1 .9, 1 X ) , Et 1 . 5, 1 X , / , 
. 8X , 6( El 1 .5, 1 X ) } 

19200 

0180 

130 

RETURN 

19300 

0181 


END 


PROGRAM SECTIONS 


Name 

Bytes 

0 SCOOE 

2002 

1 SPOATA 

851 

2 $ LOCAL 

912 

3 DEBUG 

8 

4 RESIDUALS 

96 

5 CONTRL 

12 

6 R V EC 

224 

7 ENdlR 

404 

8 ASTATE 

160 

9 TARGETS 

36 

10 NS TATE 

112 

11 PHI A 

7176 

12 PH IN 

1440 

13 ARRAYS 

1096 

14 TIME 

136 

15 UPOT 

752 

16 PLOT 

16 

17 COMPOSIT 

19624 

18 TITLE 

40 

19 LMTPAR 

392 


Attr i butas 


PIC 

CON 

REL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

PIC 

CON 

REL 

LCL 

NOSHR 

NOEXE 

RD 

NRT 

QUAD 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

G8L 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

P.d 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Nam* 
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VARIABLES 


Address 

Type 

Name 

Address 

T ype 

Name 

Address 

T ype 

Name 

Address 

Type 

Name 

19-00000000 

R*8 

AL 

14-00000038 

R *8 

OATEO 

14-00000070 

R*8 

DATER 

14-00^-0020 

R * 8 

DEL 

2-00000238 

R*8 

OELTAT 

14-00000008 

R *8 

DTA 

14-00000030 

R*8 

DTN 

14-00000080 

R * 8 

DT PRINT 

2-00000240 

R*8 

OZ 

4-00000000 

R *8 

OZHLM 

4-0000001 0 

R*8 

DZHST1 

4 -C0000020 

R * 8 

DZHST2 

4-00 000008 

R*8 

OZVLM 

4-00000018 

R *8 

0ZVST1 

4-00000028 

R* 8 

DZVST2 

2-00000248 

R • 8 

EATT 

2-00000278 

R*8 

ENAV 

2-00000284 

I *4 

1 

AP-000000043 

1*4 

ICALL 

3-00000004 

I *4 

I DEBUG 

3-00000000 

1*4 

ienter 

2-0000028C 

I *4 

II 

7-00000190 

1*4 

INI T 

2-00000280 

1*4 

INIT1 

9-00000004 

1*4 

IS 

2-00000288 

I *4 

0 

2-00000290 

1*4 

J1 

9-OOOOOOOC 

1*4 

JF LAG 

19-0000001 0 

r*s 

IAT 

19-00000008 

R *8 

LON 

9-00000010 

1*4 

MCODE 

5-00000000 

I *4 

MOP 

9-00000000 

1*4 

MTYPE 

9-00000008 

I *4 

NS 

2-00000250 

R*8 

PAT T F 

9-00000014 

R * 8 

PI 

2-00000258 

R*8 

PNAVF 

2-00000260 

R*8 

PT I ME 

1 1-OOOOICOO 

R*8 

QMAX 

6-OOOOOOBO 

R * 8 

R 2 

6-00000088 

R*8 

R3 

6-000000A8 

R • 8 

RA 

1 0-00 000068 

R*8 

RAPE 

10-00000060 

R * 8 

RA DM 

6-00 OOOOCO 

R*a 

RSMA 

19-00000 1 78 

R *8 

SIGGCP 

19-00000180 

R*8 

THET 

14-00000018 

R • a 

T I A 

14-00000000 

r*s 

TIKE 

14-00000028 

R *8 

TIN 

5-00000004 

R*8 

TINT 

14-00000056 

R *8 

T I S 

14-00000060 

R*8 

TISN 

14-00000048 

R»8 

TMEAS 

2-0000026- 

R*8 

TMLAST 

14-00000008 

R *8 

tnext 

t6-00 000000 

R*8 

TP1 

16-00000008 

R * 8 

TP2 

9-00 00001 C 

R*8 

TPI 

14-00000078 

R*8 

TPRINT 

2-00000270 

R*8 

T PUNCH 

14-00000050 

R *8 

TRACK 

14-00000010 

R*8 

TSTOP 

14-00000040 

R *8 

T2ER0 


ARRAYS 


Address 

Type 

Name 

Bytes 

Dimensions 

2-00000180 

R*8 

AT 

72 

(3, 

3) 

1 

18-00000000 

L* 1 

ATITLE 

40 

(40) 

19-OOOOOOC8 

R*8 

BKL 

16 

(2) 


19-00 0000 A8 

R*8 

BL 

16 

(2) 


1 7—00 00 1 E40 

R*B 

cov 

3072 

(22, 

22) 

1 i-ooooocoo 

R*8 

COVA 

2048 

(16, 

16) 

12-00000360 

R*B 

COVN 

288 

(6, 

6) 

8-00000070 

R*8 

0 

24 

(3) 

8-00000088 

R*8 

00 

24 

(3) 


8-00000000 

3*8 

OE 

32 

(4) 


2-000001 E8 

R*8 

OSTATE 

80 

(10) 

4-00000030 

R*B 

OXMGPS 

48 

(6) 


8-00000020 

R* 8 

E 

32 

(4) 


1 7-00003C80 

1*4 

IP 

88 

(22) 


17-00003088 

R*8 

P 

3872 

(22. 

22) 

1 1-00000000 

R*8 

PA 

1 28 

(4, 

4) 

2-00000100 

R*e 

PAT 

1 28 

(4, 

4) 

2-0C 000080 

R*a 

PATT 

1 28 

(4 , 

4) 

11-00000200 

R*8 

PDA 

512 

(4, 

16) 

17-000001 20 

R*8 

PDN 

2 88 

(6, 

6) 

17-00000000 

R*8 

PHI 

3872 

(22, 

22) 

1 1-00 000400 

R*8 

PHI A 

2048 

(16, 

16) 

12-00000240 

R*8 

PHIN 

288 

(6, 

6) 

12-00000000 

R*8 

PN 

288 

(6, 

6) 

17-00002060 

R*8 

PO 

3872 

(22. 

22) 

11-00001400 

R*8 

POA 

2048 

( 16. 

16) 

12-00000480 

R«8 

PON 

288 

(6, 

6) 

7-00000050 

R*8 

PROFILE 

320 

( 10 , 

4) 

1 5-00 000080 

R*8 

0 

288 

(6, 

6) 

15-00000030 

R*8 

QA 

1 28 

(16) 


15-00000100 

R*8 

000 T 

288 

(6. 

6) 


296 
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15-00000000 

R*8 

ON 

17-00OOOF20 

R*8 

OT 

6-00 '00000 

R»8 

R 

6* 0000001 B 

R»9 

RM 

6- C *000030 

R«8 

RO 

6-00000048 

R*8 

RSM 

6-00 000060 

R*8 

RSO 

6-00000078 

R»8 

RSS 

6-oooooocn 

R-8 

RTG 

6-00 000090 

R»8 

SB 

8-00 000058 

R*8 

SF 

19-00000008 

R»6 

SKL 

19-00 0000 B8 

R«8 

SL 

2-00 000 1 C8 

R*8 

ST 

7-00000000 

R*8 

STATE 

13-00000000 

R*8 

T 1 

13-00000098 

R*8 

Til 

13-00000018 

R«8 

T 2 

13-00000030 

R*8 

T3 

13-OOOOOOEO 

R»8 

T33 

13-00000048 

R*8 

T4 

13-00000128 

R*8 

T44 

2-00000000 

R«B 

T44T 

1 3-000003E8 

R«8 

T5 

13-00 000408 

R*8 

T6 

13-000001 A8 

r*b 

T66 

13-00000428 

R*8 

T7 

1 3—00 0002C8 

R*e 

T77 

11-00000080 

R«a 

TA 

19-00000018 

R»8 

TBNL 

1 9-000001 30 

R*8 

TIEO 

19-00000060 

R*8 

TNL 

19— 000000E8 

R»B 

TNLK 

8-00000040 

R*B 

HO 

10-00000030 

R*8 

X 

10-00000000 

R*B 

XO 

1 7-00 003CO8 

R*8 

XT 


48 

( 6 ) 


3872 

( 22 . 

22 ) 

24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( 3 ) 


24 

( - 1 


16 

( 2 ) 


16 

( 2 ) 


32 

( 4 ) 


60 

( 10 ) 


24 

( 3 ) 


72 

( 3 . 

3 ) 

24 

( 3 ) 


24 

( 3 ) 


72 

( 3 . 

3 ) 

80 

( 10 ) 


1 28 

( 4 . 

4 ) 

1 28 

( 4 , 

4 ) 

32 

( 4 ) 


32 

( 4 ) 


238 

( 6 , 

6 ) 

32 

( 4 ) 


288 

( 6 . 

6 ) 

384 

( 4 . 

12 ) 

72 

( 3 . 

3 ) 

72 

( 3 , 

3 ) 

72 

( 3 . 

3 ) 

72 

( 3 . 

3 ) 

24 

( 3 ) 


48 

( 6 ) 


48 

( 6 ) 


176 

( 22 ) 


LABELS 


Address 

Lab* 1 

Addres* 

Label 

Address 

1-00000000 
* « 

0- 000003B7 

1- 00000256 

• • 

1-00000010 

1-0000008B 

1-00000047 

5’ 

20 

70 

106' 

112 

145’ 

175' 

1156* 

0*00000070 

• • 

• 0 
00 
00 

0*0000 00 FB 
0*0000 01 A3 

10 

30 

80 

107 

113 

150 

180 

0- 00000049 

1- 00000165 

• * 

1-0000026F 
1-000001 8A 
1-00000064 
1 -OOOOOOEA 


Label 

Address 

Lab* 1 

Address 

label 

Address 

13 

40' 

90 

108' 

115' 

155' 

195' 

l-OOOOOOOC 
1-00000345 
1-0000020B 
* » 

0-000006D8 
0-00000173 
0-000001 rO 

14' 

45' 

100* 

109 

120 

160 

220 

0- 00000 1B9 

*• 

1- 0000024E 
1-00000285 

• • 

1-00000096 

1-00000234 

15 

50 

103' 

110' 

125' 

165' 

992* 

1-000001 19 
1-000001 EO 
*• 

1-00000325 

0-00000701 

0- oooooi as 

1- 00000031 




Label 

18 ’ 

88 * 

185 

111 * 

138 

1TO 

1155 ' 
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FUNCTIONS ANO SUBROUTINES REFERENCED 
MATAB MTHSOSQRT RUNG 


Tot*? Space Allocated ■ 35489 Bytes 


command qualifiers 


FORTRAN /L OUTOATA 


/CHE CK<( NO BOUNDS .OVERFLOW) 

/?7? UG ^g! V f^t^ RA /m AC /optimi2e /narnings /noo.lines /nomachine.code /continuations.19 


COMPILATION STATISTICS 

Run Time: 7.31 seconds 

Elapsed Time: 24.43 seconds 

Page Faults: 50e 

Dynamic Memory: 109 pages 


2.9 Plotting and Utility Routines 


Tha following routlnas ara includad for complatanaaa. Thay ara all 
routinaa aiaociatad with GCP8IM aa plotting and utility routinaa. 


A-293 


20-Apr- 1981 1509:13 
20 “Apr- 1 981 15:05:15 


VAX-11 FORTRAN .2.0-2 
_0BC5: [D1 IN. GC*' ]CLDT BL .FOR : 16 


P«S<? 


1 








00 100 0001 

00200 
00300 
00400 
00500 
00600 
00700 
00800 
0C900 
0<000 
01100 
01200 
01300 
01400 

01500 0002 

00100 0003 

00200 0004 

00300 
00400 

01600 0005 

00100 0006 
00200 
00300 
0C400 
> 00500 

00600 
'C 00700 
^ 00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 

01700 0007 

00 100 

00200 0006 
00300 

00400 0009 

00500 
00600 
00700 
00800 
00900 
01000 
01100 
01200 
01300 
01400 
01500 
01600 
01700 
01600 
01900 
02000 
02100 


c< 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE CLOTBtl X.'-'CNT I 


subroutine cldtb.. computes a percent of cloud cover 

BASED ON THE RANDOM NUMBER X. 

INPUT PARAMET RS 

X r A RANDOM NUMBER BETWEEN 0-1 

OUTPUT PARAMETERS 

PCNT = T HE PERCENT CLOUD COVER 
CALLEO BY MEASURE 


INCLUDE 'CLOUD.COM' 

COMMON /CLOUD/ CL0TBL112) 

RE AL*8 CLOTBL 

PCNT TH PERCENTAGE OF CLOUD COVER 

INCLUDE 'MOOE.COM' 

COMMON /MODE / MODE ( 10 ) 

MOOE ( 1 ) « LANOMARK TRACKER SWEEP MODE 

0 > RANDOM 

1 ■ FIXED AT INPUT TMET 

2 « NO DEFAULT TO STAR TRACKER 
MOOE <2$ * CLOUD SELECTION MODE 

0 • RANDOM CLOUD DENSITIES BASED 

ON INPUT TABLES CLOTBL 

1 • FIXED DENSITY AT NO CLOUDS 

2 • NO CLOUDS WITH 1 30X CLOUD 

COVER for a specified 

PERIOD (CLOTBL! 11,12)) 

MOOE (3-10) NOT SPECIFIED AT PRESENT 

INC LUO E 'TIME.COM' 

CODMON / T IMC/ T IME . TNEXT . TSTOP. T IA.DEL . TIN, OTN. DAT EO, TZERO 

.TMEAS. TRACK, TIS.TISN.DTA.DATER.TPRI NT. OTPRINT 
REAL'S T IME, TNEXT . TSTOP. T I A, DEL . T IN . DTN .DATEO , TMEAS , TRACK , T I S . 

. T ISN. DT A. TZERO. DAT ER.TPR I NT. OTPRINT 

THESE ARE THE TIME REFERENCE FRAMES 

TIME ATOMIC TIME SINCE 1 N I T I A L I Z AT ION (SEC) 

TNEXT TIME FOR NEXT POSITION INTEGRATION (SEC) 

TSTOP RUN TERMINATION TIME (SEC) 

TIA ATTITUOE INTEGRATION TIME (SEC) 

0 L " * STEP SIZE ( SEC) 

TIN POSITION INTEGRATION TIME (SEC) 

DTN * ’ STEP SIZE (SEC) 

DATEO DATE OF FLIGHT EPOCH (UD) 

OATER DATE OF 1950 EPOCH (JD) 

TZERO START TIME IN SECS. SINCE DATEO 

TSLEW TIME NEEDED TO SLEW ANO ACQUIRE (SEC) 

TIS REAL WORLD REFERENCE TIME (SEC! 

T ISN TIME FOR NEXT RW POSITION INTEGRATION (SEC) 




CLOTBL 


20 “Apr- 1 9g i 15:09:13 
20-Apr-l 981 15:05:15 


VAX-11 FORTRAN V2.0-2 
_DBC5: I D 1 1R. CCP JCLOTBL . FOR ; 16 


02200 
02300 
02400 
02500 
02600 
01 BOO 
01900 
02000 
02100 
02200 
02300 
02400 
02500 
02600 
02700 
02800 
02900 
03000 
03100 
03200 
03300 
03400 
03500 
33600 
03700 


> 

l 


0010 
001 1 
0012 

0013 

0014 

0015 


0016 

0017 

0018 

0019 

0020 
0021 
0022 

0023 

0024 


• C 

• c 

• c 

• c 

• c 


c 

c 

c 

c 

c 


OTA USUALLY ♦ DEL BUT ♦ T SLEW - TIA WHEN DEL 

TOO LARGE AT MEASUREMENT TIME 
TPRINT TIME FOR PRINT ( SEC ) 

DTPRINT INCREMENT ON TPRINT (SEC) 


REAL'S PCNT 

T>CNT*0 . 

CO TO (20.30 ) .MODE (2) 
I-X'IOAl . 

1H 1 . LT. 1J 1*1 
*F(I .GT. 10) GO TO 10 


INTERPOLATE CLOUD TABLE DATA 


10 

20 

33 

100 


PCNT«( CLOTBl ( I ♦ 1 )-CLOTBL(l))»(X»10-: )eCLOTBL(l) 

GO TO 100 
PCNT *C LOTBL( 1) 

GO TO 100 
PCNT.O . 

GO TO 100 

.PUTIME.OE. CLOTBL! 11)). ANO. < T I ME. L£ . CLOTBL ( 12) > )PCNT. 100. 
END 


PROGRAM SECTIONS 


Nan® 


0 SC ODE 

2 SLOCAL 

3 CLOUO 

4 MODE 

5 TIME 


Bytes 

Attr i but** 






151 

PIC CON 

REL 

LCL 

SHR EXE 

RD 

NOWRT 

LONG 

4 

PIC CON 

pel 

LCL 

NOSMR NOEXE 

RD 

MRT 

LONG 

96 

PIC OVR 

REL 

G8L 

SHR NOEXE 

RD 

NRT 

LONG 

40 

PIC OVR 

pel 

G8L 

SHR NOEXE 

RD 

MRT 

LONG 

136 

PIC OVR 

rcl 

CBL 

SHR NOEXE 

RD 

MRT 

LONG 


OINTS 

Add-ess T yp* Nam* 
2-OOOCOOOO CLOTBL 


VARIABLES 


Address 

Typ* 

Nam* 

5-00000038 

R»8 

OATEO 

5-00000030 

R*8 

GTN 

5-00 0000 18 

R*a 

TIA 

5-00000060 

R»8 

TISN 

5-00 000050 

R*B 

TRACK 


Address 

T yp* 

Nam* 

5-00000070 

R*8 

DATER 

5-00000080 

R *8 

DTPRINT 

5-00000000 

R *8 

TIME 

5-00000040 

R*8 

TMEAS 

5-00000010 

R*8 

TSTOP 


Add-ess 

Type 

Nam* 

5-00000020 

R* 8 

DEL 

2-00000000 

1*4 

I 

5-00000028 

B*8 

TIN 

5-00000008 

R*8 

'NEXT 

5-00000040 

R»B 

TZERO 


Address 

Typ* 

Sam* 

' -00000068 

R*8 

DTA 

AP- 00000 008M 

R*8 

PCNT 

5-00000058 

R*8 

T1S 

5-00000078 

R *8 

TPRINT 

AP- 00000004# 

R*4 

X 


I Of-' 


CLOTSL 


ARRAYS 


20-Apr-1961 1 5 : u9 : 1 3 VAX-11 FORTRAN V2.0-2 
20-Apr-19B1 15:05:15 _OBCS: (D11R.GCF>]CLOTBL.FOR;16 


Address Type Name 


«y tes Dimensions 


3- 00000000 R*R CLOTBL 

4- 00000000 1*4 MODE 


96 (12) 

40 (10) 


LABELS 

Address Lst># I 
0-00 00005D 10 


Address Label 
0-0000 00M 20 


Address Label 
0-00000070 SO 


Address Laos) 
0-00000096 100 


Total Space Allocated ■ 427 Byt >s 


COMMAND DUAL I TIERS 

FOR T A A.4 /L CLOT8L 

/CHECK. (NO BOUNOS .OVERFLOW) 

/DEBUG. ( NOSYMBOL S , TRACEBACK ) 

/F77 /nog floating /14 /optimize /warnings /moo.lixe* /nomacmine.cooe /continuations-!# 


COMPILATION STATISTICS 


Run rime: 
Elapsed Time: 
Rags Fau>ts: 
Dynamic Memory! 


1.19 seconds 
57. B7 seconds 
141 

30 pages 


Page 3 


COMP . COM 



COMP.COM COMPILED ALL THE NECESSARY ROUTINES OR EXECUTION 
OF THE GCP SIMULATION PROGRAM 



I /DE6UG/NOOPT IMIZE- 
INOATA,- 

MATAB. - 

OUTDATA,- 

RUNG,“ 

ONAV 

EPHEM,- 

TRUEA, - 

SPRESS,- 

OCCULT,” 

GPERT 

MATA8. - 

ON AV.- 

EPHEM. - 

TRUEA.- 

SPRESS 

OCCULT.- 

GPERT,- 

GC PSEQ.~ 

VISIBLE,- 

OCCULT," 

GENENV.- 

TREG.- 

GYROUT,- 

RATE 

BMAT 

CMAT 

MATAB.- 

MINV3,- 

GAUSS.- 

KATT,- 

BM AT , - 

CMAT 

MATAB,- 

VMULT,- 

UNIT,- 

RUNG,- 

DNAV .- 

EPHEM,- 

TRUEA,- 

SPRESS,- 

OCCULT 

GPERT , - 

GYRO,- 

KATT.- 

BMAT , - 
CMAT 
MATAB.- 
OMU L T . - 
UNIT 

POATT.- 

MATAB,- 

PATT,- 

MEASURE,- 

RANOU,- 

CLDTBL 



,-303 


ROGCP 




TRUEA , - 
OCCULT, - 


MATAS, “ 


I III I I II 1 1 I 1 I I II 


UTILITY functions 



6~Apr-1981 15=05:32 
20-0ct-1980 07:07:57 


VAX-11 FORTRAN V2.0-2 
_DBA0: [D1 1R.GCPlCRAlSE.F0R :6 


Pane 


00100 

0001 

00200 


00300 


00400 


00500 


00600 


00700 


0L'800 


00900 


01000 


01100 


01200 


01300 


01400 

0002 

01500 

0003 

01600 

0004 

01700 

0005 

01800 

0006 

01900 

0007 

02000 

0008 

02100 

0009 


SUBROUTINE CRA I SEl N . COV .COVWIN . I PT ) ...... 

RA I SES*Dl AGONAL* ELEMENTS OF THE COVARIANCE MATRIX IF THEY DROP 

B M CE MN VALUES AND THEY ARE BEING ESTIMATED. 


FORMAL PARAMETERS u . TQt » 

N = NUMBER OF ROWS 0« COLS IN COVARIANCE MATRIX 

cov « covariance matrix 

C07MIN . MINIMUM VALUES FOR EACH VARIANCE 
IPT. ARRAY OF 1-S and 0'S. A 1 INDICATING THAT 


A PARTICULAR 


Q PARAMETER IS being estimated 


100 


DIMENSION COV(N.N) , COVMI N ( N ) , I PT 
' DIMENSION CtlV(22.22) ,C0VMIN(22 ) , IPT(22) 
real«b cov.covmin 
DO 100 I . 1 ,N 

IF (IPT(I).EQ.O) GO TO 100 
IF ( COV ( I » I ) • LT . COVMI N( I ) ) COV(I.I) ■ 
CONTINUE 
RETURN 
ENO 


COVMI N ( I) 


PROGRAM SECTIONS 


Name 


T 0 SCOPE 
g 2 SLOCAL 


Bytes Attribute* 

103 PIC CON REL LCL SHR EXE 

64 PIC CON REL LCL NOSHR NOEXE 


RD NOWRT LONG 
RD WRT LONG 


ENTRY POINTS 


Address Type Name 
0-00000000 CRAISE 


VARIABLES 


Address Type 

Name 

Address 

Type 

Name 

2-00000000 1*4 

I 

AP-00000004P 

1*4 

N 

ARRAYS 

Address Type 

Name 

Bytes 

D i mens i on* 

AP-00000008* R«8 
AP-00 OOOOOCP R»B 
AP-00000010# 1*4 

COV 

COVMI N 
IPT 

3872 
1 76 
88 

(22, 

(22) 

(22) 

22) 


not 


6-App-i98i 15 : 05:32 
20-0ct-1980 07:07:57 


VAX-11 FORTRAN V2.0-2 
_0BA0: [Ot1R.GCPlCRAISE.FOR ;6 


Address Laos I 
0—00 00005F 100 


Total Space Allocated • 167 Bytea 


C0«MAN0 QUALIFIERS 


fortran /LIST GCP, INDATA. MATAB.OUTOATA. RUNG. ONAV.EPHEM.TRUEA.SPRESS.OCCJLT.ORERT.OCPSEO. VISIBLE. GCNfHV.TREG.OVROUT. BATE. WAT. CM* 
/CHECK *< NO BOUNDS .OVERFLOW) 

/ F 77 /NOO ^ FLOAT INC***/ I4* C /0PTWI2E /WARNINGS /N00.LINE5 /NOMACHINE.COOE /CONT INUAT IONS- 1 9 


COMPILATION STATISTICS 

Run T i me : C 
E ' apsed Time: 1 
Page Faults: I 
Dynamic Memory: 1 


0 . 59 seconds 
14.93 seconds 
274 

160 pages 



Page 


8-*or- , jdl 07:3a:5l VAX-11 FORTRAN 72.0-2 
26-Nov-1980 ii:4i:32 _08A0: [01 1R.GC P ]CRESIF -FOR : 5 


0001 SUBROUTINE CRE SI F ( XT RANS . X ! N . X TR ANP , XOUT ) 

C 

c this routine transforms error vectors from inertial tg flight 

c 


0002 

C 

RE AL»8 X1N(3) . XOUT (3 ) ,XTRANS(3.3 ) , XTRANP{ 3 . 3 ) , XT EM 0 1 3 ) 

'.'003 


00 10 1*1,3 

0004 


RSUM=0 

0005 


00 5 J = 1 .3 

0006 


RSUM * RSUM* XTRANSI J. I ) *XIN< J ) 

0007 

5 

CONTINUE 

0008 


XTEMP( I )*RSUM 

0009 

10 

CONTINUE 


C 


0010 


DO 20 1*1,3 

0011 


RSUM*0 

0012 


DO 15 J*1 .3 

0013 


RSUM * RSUM* XTRANPIJ, I ) • X T EMP ( J ) 

Or .4 

15 

CONTINUE 



XOUT ( I ) *RSUM 

OC 

20 

CONTINUE 

0017 


RETURN 

0018 


END 


PROGRAM SECTIONS 
Name 


~ 0 SCOOE 

2 SLOCAL 


E“'RY points 

Address Typa Nana 
0-00000000 CRESIF 


VARIABLES 

Address Type Name 
2-00000018 1*4 I 


ARRAYS 


Bytes 


At tr i butea 


169 
1 16 


PIC CON REL LCL SHR EXE 
PIC CON REL LCL NOSHR NOEXE 


RO NOWRT LONG 
RD WRT QUAD 


Address Type Name 
2-00000020 1*4 0 


Address Type Name 
2-0000001C R*4 RSUM 


Address Type 

Name 

Bytes 

Di mens Iona 

AP-00 0000088 R*8 

XIN 

2r 

(3) 

AP-00 0000108 R*8 

XOUT 

21 

(3) 

2-00000000 R*8 

XTEMP 

24 

'3) 








a -Apr- 1 981 07:38:51 
aa-Nov-1980 17 : 4 1 : 32 


VAX-11 FORTRAN V2.0-2 
_DBAO: I 0 1 1R.GCP]CRES1 F.FOR :5 


Page 2 


AP-OOOOOOOC# R*a XTRANP 
AP-00 000004* R*S XTRANS 


72 (3. 3) 

72 (3. 3) 


LABELS 


Address Labe 1 


Address Lapel 


Address Label 


Address label 


Total Space Allocated ■ 285 Bytes 


-309 


I 


Page 


8" Apr- 1 98 1 07=38:51 VAX-11 FORTRAN V2.0-2 
28-Nov-l 980 11:41:32 _OBAO t [D 1 1 R . GC>' 1CRE5 1 F . FOR ; 5 


C 


COMMANO QUAl IFIERS 


FORTRAN CRESIF/L IS 


/CHECKS (NO BOUNDS .OVERFLOW) 

/CEBUG^I NO SYMBOL S. TRAC E8ACK ) 

/F77 /NOG_FLOAT ING / 14 /OPTIMIZE /WARNINGS 


/NOD_LINES /NOMACHINE.CODE 


/CONT INUAT I ONS* 1 9 


COMPILATION STATISTICS 

Run Time: 0.79 seconds 

Elapsed Time: 2.00 seconds 

Page Fau Its: 106 

Dynamic Memory: 28 pages 


> 


8-Apr-19B1 07:36:42 VAX-11 FORTRAN V2.0-2 
28 -Nov- 1 980 10:54:53 _DBA0: [ D 1 1 R . GC R JCRTR AN . FOR : 4 


0001 


0002 

0003 

0004 

0005 

0006 

0007 

0008 

0009 

0010 
001 1 


c 

c 

c 

c 


5 

10 

c 


SUBROUTINE CRT RANI XT PANS. X IN.XOUT ) 

THIS ROUTINE TRANSFORMS ERROR VECTORS FROM INERTIAL TO F I !GHT 

REAL'S XIN13) , XOUT ( 3 ) . XTR ANS ( 3 . 3 ) . RSUM 

DO 10 1*1 .3 
RSUM«0 
DO 5 J * 1 , 3 

RSUM=RSUM*XTRANS( J.I )*XIN(d) 

CONT INUE 
XOUT( I I « RSUM 
CONTINUE 

RETURN 

END 


PROGRAM SECTIONS 



Name 

Bytes 

At tr i Outes 






0 

SC ODE 

100 

PIC CON REL 

LCL 

SHR 

EXE 

RD 

NOWRT LONC 

2 

SLOCAL 

76 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT QUAD 


ENTRY POINTS 

Address Type Name 
0-00000000 CRTRAN 


VARIABLES 


Address Type 

Name 

Aadr ess 

Type Nama 

Address 

Type 

Name 

2-00000008 1*4 

1 

2-OOOOOOOC 

1*4 d 

2-00000000 

R*8 

RSUM 

ARRAYS 







Address Type 

Name 

Bytes 

Di mens i ona 




AP— 00 0000 OOP R*8 

XIN 

24 

(3) 




AP-00 OOOOOCP R*8 

XOUT 

24 

(3) 




AP— 00 000004 P fl*B 

XTRANS 

72 

(3, 3) 





Pacje 


ORIGINAL PAGE IS 
OF POOR QUATTTv 


1 It 



CRTS AN 


8 -Apr- 1 981 07:38:42 
28-NOV-1980 10:54:53 


VAX-11 FORTRAN V2.0-2 

_DBA0 : f 0 1 1 R . GC P ] CRT RAN . FOR ; 4 


P«Oe 


LABELS 

Address 


Labe 1 
5 


Address 


Labe 1 
10 


Total Space Allocated ■ 17S Bytes 


> 

i 








Z If.- 


28-Nov-190O 10:5^:53 


»»*•! 1 r(jh ! HAN 


_0BA0: [OttR.CC>' , CRT RAN. FOR ; 4 


Paye 


C0MMAN0 OUALIFIERS 

FORTRAN CRTRAN/L is 

/CHE CK = ( NO BOUNDS . OVERT LOU) 

/DEBuG^ I NO SYMBOL S. TRAC EBACK ) 

/F77 /NOG.FLOAT ING /I*. /OPTIMIZE 

COMPILATION STATISTICS 


/•ARNiNGS /NOO_LINES /NOMACHINE.CODE /CONTINUATIONS*^ 


Run T i me : 

E t mo sea T i me : 

Page faults: 

Dynamic I'traorv ■ 


0 . S4 seconds 
2.24 seconds 
99 

28 pages 






'6-5*0-1990 12 : 4 1 : 3 1 . a > - i i 'OSTRIN IW-PLUS VI. 0-2 Page 1 

gain . roa.2 


ocoi 


RE A L • 4 X ( 1000 . 6) .TIME1 1 COO 

. X A B A Y ( 1000 ) 

0002 

0003 


OPEN! UNI T«t .NAME* 'GA IN. OAT ' 
I ’ 1 

.TYPE*' OLD ' , RECORDS I ZE- 98 ) 

0004 

2 

COMINUE 


0C05 


RE *0* 1 . 3 . END *4 ) T 1ME ( !).(*< 1 

I . J ) . J * 1 .6 ) 

O' 06 
OCOT 
0009 

3 

«• 0 RVAT ( 7 E 14 . 7 ) 
1^1*1 

GO TO 2 


0 009 
0010 

4 

CONTINUE 

I T NUM* I - 1 


0C1 1 
0012 

6 

CONTINUE 
t»P 1 TEI 5. 101 


0C1 3 
0014 

10 

EOPVATf' INPU1 PLOT NUM0E P 
BE A0< 5. 20 ) ITYPE 

i-1=E*IT) : ',$) 

0C15 

20 

E C QVA T ( I 5 ) 


00 16 
00 1 7 
0018 


IEilTTPE.EO.-1 .OB. ITYPE. GT . 
DO 30 I.1.ITNUM 

XAQAY 1 I )«*< I .ITYPE ) 

.6)00 TO 9000 

0019 

0020 
0021 

30 

CONT INUE 
CALL MP7221 
CALL OQh P i 0 . .0 . .6) 


0022 

0023 


CALL LINPLT(TI ME , AAR AY , I TNUM) 
GO TO 6 

0024 

002$ 

9000 

CONTINUE 

ENO 



TH. 


gainsmain 


H-Sip-IMO 12:41:31 


•AA-11 FORTRAN IV-PLUS VI . 0-2 

GA ! N . FOR . 2 


Rage 2 


PROGRAM SECT IONS 




Bytes 

At t r > Do t e s 







0 

SCCJDE 

244 

PIC CON REl 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

1 

SPDATA 

62 

RIC CON REL 

LCL 

SM9 

NOEXE 

RO 

NOWRT 

LONG 

2 

slocal 

320B0 

RIC CON REL 

LCL 

NO SHR 

NOEXE 

RO 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 GAINSMAIN 


VARIABLES 


Address 

Type 

Name 


Address 

Tyoe Name 


Address 

Type Name 


Address Type Name 

2-00 007000 

1*4 

I 


2-00007008 

1*4 ITNUM 


2-00 Or7DOC 

1*4 I TYPE 


2 -00007D04 1*4 d 

ARRAYS 











Address 

Type 

Name 


Bytes 

Dimensions 






2-00 OOSOCO 

R*4 

TIME 


4000 

(1000) 






2-00000000 

R*4 

X 


24000 

< 1000,6) 






2-00006060 

R*4 

XARAY 


4000 

(1000) 






LABELS 











Address 

Labe 1 

Address 

Lao* i 

Address 

Label 

Address 

Label 

Address 

Label Address 

0-00000014 
• • 

2 

30 


1-0000001 1 
0-C00000F0 

3' 

9000 

0-00000067 

4 

0-0000006C 

6 

1-00000017 

10' 1-0000003B 


FUNCTIONS and subroutines referenced 

FORSOREN HP7221 LlflPLT QQmR 


Total Space Allocated - 323B6 Bytes 


COMPILER OPTIONS 

/CHECH . ( NOBOUNOS .OVERFLOW) 
/OEBUGHNOSYMBOLS. TRACES ACK) 

/ORTIMUE /WARNINGS / 1 4 /NOO.LlNES 


Laos i 
20 ' 


FUNCTION GAUSS (MEAN 


VAX-11 FCRTRAN .2.0-2 
_DBAO: [Omr.GC - IGAJSS.FOR; 1 l 


Page 


1 


6-Aor-1981 14:50:49 
2S-tUr-1981 09:00.45 


OdOO 

0001 



0C200 



C 

O' 300 



C 

0L400 



C 

OC 500 

0002 



OC *00 

0003 

• 


0* 200 


• 

c 

O'. 300 


• 

c 

OC400 


• 

c 

0'.*00 


• 

c 

0C600 


• 

c 

00700 


• 

c 

CC600 

0004 



00700 

0005 



00800 

0006 



00900 

OOu? 



01000 

0008 


1 

01100 

0009 



01200 

0010 



01300 

0011 




. . i St A | 


RANDOM NOISE SENl»ATCR USING PARAMETER VEAN AND STANDARD DEV 


INCLUDE * 0EBUG.COM 

COMMON / DEBUG/ IEN'E». iOEBUG 

USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

I NTER IE 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
IDEBoG 0-10, H1GMCR NUMBER MEANS MORE PRINT 

RE AL *8 MEAN, SIGMA. GAUSS, RAN 
DATA II. 12/12345,54321/ 

GAUSS • 0. 

DO 10 I « 1 , 1 2 

GAUSS • GAUSS ♦ RAN t 11.12 1 
GAUSS • MEAN ♦ SlGVA‘IGAUSS-6. ) 

RETURN 

END 


PROGRAM SECTIONS 


5' a -<• 


Bytes Attribute* 


0 SC ODE 

2 SLOCAL 

3 debug 


52 PIC CON R£l 

32 PIC CON REL 

8 PIC OVR REL 


LCE SHR EXE 
LCL NOSMR NOEAE 
GBL SHR NOEXE 


RD NOWRT LONG 

rd mrt Quad 
RD MRT LONG 


ENTRY POINTS 


Address 
0-20 OOOCOO 

Type 

R*B 

Name 

GAUSS 









VARIABLES 

Address 

Type 

Name 

Address T 

ype 

Nam# 

Address 

Type 

Nan# 

Address 

Type 

2- 0000001C 

3- 00000000 

1*4 

1*4 

I 

1ENTER 

2 -00000008 
AP -00000004# 

1*4 

R*8 

1 1 

mean 

2-OOOOOOOC 

AP-00000008P 

1*4 

R»8 

12 

SIGMA 

3-00000004 

1*4 


LABELS 

Address tab* 1 
* • 


Name 

IOEBUG 


10 


316 






r»*9t*f»«<» -.; :,. s „, ^ 


GAUSS 


FUNCTIONS ANO SUBROUTINES REFERENCED 


w 1 •’V' “ 

. k.i f 


6-Apr-l 981 14:50:49 VAX-11 FORTRAN V2.0-2 Page 2 

25“Mar-19B1 09:00:45 _DBA0: [ D 1 1 R. GC P ] GAUSS ■ FOR : 1 1 


FORSIRAN 


Total Space Allocated • 92 Bytes 


COMMAND QUALIFIERS 

FORTRAN /LIST GC P , INOAT A .MAT AB.OUT DATA . RUNG , ONAV , EPHEM , TRUEA , SPRESS , OCCULT ,GPERT , GCPSEQ . V I SI BL E , GENENV , TRE G , GYROUT , R AT E , BMAT , CMA 

/CHECK- ( NO BOUNOS .OVERFLOW) 

/DEBUGS ( NOSYMBOLS . TRACEBAC < ) 

/F77 /NOG .FLOAT I NG /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE CODE /CONT INUATIONS-19 


COMPILATION STATISTICS 

Run t ime: 

Elapsed Time: 

Page Faults: 

Dynamic Memory: 


0.58 seconds 
6.23 seconds 
337 

160 pages 
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0001 


0002 

0003 

0004 

0005 

0006 

0007 

0008 

0009 

0010 
001 1 
0012 

0013 

0014 

0015 

0016 

0017 

0018 


0019 

0020 


0021 


C 

C- 

C 

c 

* c 

• c 


• c 


GCPPLOT (GCP plot ROOT I N _S ) 


INCLUDE 'ARRAY. COM' 

COMMON BLOCK USED FOR PLOTTING ROUTINE 

COMMON /ARRAY/ X ( 300 0 . 39 . 2 I . INUM 
REAL*4 X . X 1 ( 3000 , 39 1 ,X2(3000,39) 

I N TEGER * 2 INUM 

EQUIVALENCE < X 1 ( 1 . 1 ) . X < 1 . 1 ■ 1 ) ) . < X2 ( 1 . 1 ) . X< 1 , 1 


2) ) 


CH AR ACTE R *64 
CH AR ACT E R * 20 
CH ARACTE R* 40 
CH ARACTER*50 
LOGICAL* 1 
LOGICAL* 1 
IN! EGER* 2 
RE AL*4 
EQUIVALENCE 
EQUIVALENCE 
DATA 


DATA 

OATA 


DATA 

DATA 


MENUS! 23.6) 

XTIT.YT IT(4| 

X REF ( 2 ) 

A TYPE ■ A XT I T I 20 I , A YT I T ( 80 ) ,ATITLE(19C0),ABELLS(10) 
ATIT(64),A0TYPE.AREF(80). AFRAME( 2 ) 

I OPTS ( 4 I . IT YPE , i M A X ( 4 ) , I0FF(4) . IOPTOF ( 38) , I FRAME 
T IMEI30 00) , YARRAYI 1 2000) 

( AXTITd ) .XT IT ) . (AYTIT(1 ) . VTIT(1 ) ) 

( A TITLE! 1 ) ,CTITLE( 1 ) ) , ( ARE F ( 1 ) , XREF( 1 ) ) 

I FRAME/ 1 / 

XOPTOF/ 2 ! all'.a! 12 ! 13'. 1 ^ 12 ( 5 . 6 . 7 . 8 , IS. 16, 17, 15.9, 10. 11 ,9. 

19,20,21 ,19.22.23,24,25,26,27,28.29,30.28,31 ,32,33, 
31/ 

IMAX/8,8. 8, 14/ 

IQFF/0,8. 16.24/ 


DATA MENUS/ 


WELCOME to the GCP simulation plot ', 

, I | I II 

rout 1 nes . • . « » 

These plot routines allow the user to over i ay up 
to 4 plots as long as the plots to be generated 
are of tre same units. The user will be prompted 
by the command 0PTI0N» or by the sentence Hit 
RETURN to continue » . The user has the option 
of using the HP7221 Hewlett PacKard plotter (H) 
or the 4014 Tectronix plotter (T). If the user is 
using the HP7221, before this task may be run he 
must type in ASSIGN TT07: F0R010 so that the 
HP7221 will be properly assigned. 

|1II»11 
• • • * 

1 I * » 1 » 1 f * • # 

The following are the type(s) of plot(s) which 

may be generated '• ', 

1 POSITION ERRORS < KM ) 

2 VELOCITY ERRORS (KM/SEC) 

3 ATTITUDE ERRORS (ARC SEC) 

4 RESIDUALS (KM OR KM/SEC) 

-1 EXIT PLOT ROUTINES 


POSITION ERROR PLOTS 

1 NAVIGATION X POSITION 


C? 


Page 
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NAVIGATION Y POSITION 
NAV IGAT ION Z POSI T ION 
RSS POSITION ERROR 
STANDARD DEV. X POSITION 
STANDARD DEV. Y POSITION 
STANOARD DEV. Z POSITION 
RSS STANDARD DEV. POSITION 


i iii iii ii 

VELOCITY ERROR PLOT! 

1 

2 

3 

4 

5 

6 

7 

8 


NAVIGATION X 
NAVIGATION Y 
NAVIGATION Z 
RSS VELOCITY 
STANDARD DEV, 
STANDARD DEV, 
STANDARD DEV, 
RSS STANDARD 


RESIDUALS 


VELOCITY 

VELOCITY 

VELOCITY 

ERROR 

X VELOCITY 
Y VELOCITY 
Z VELOCITY 
DEV. VELOCITY 


• 

(ROR 

• » » 

1 I 

PLOTS : • , • ’ , • • , 



1 

ROLL 



2 

PITCH 



3 

YAW 



4 

RSS (ROLL, PITCH AND YAW) 


S 

standaro DEV. ROLL 



6 

STANDARD DEV. PITCH 



7 

standaro dev. yaw 


1 ' . 

8 

STANDARD DEV. RSS 
« • 


1 

L.M. 

TRACKER HORIZONTAL 

(KM) 

2 

L.M. 

TRACKER VERTICAL 

(KM) 

3 

STAR 

TRACKER 1 HORZ. 

(KM) 

4 

STAR 

TRACKER 1 VERT. 

(KM) 

5 

STAR 

TRACKER 2 HORZ. 

(KM) 

6 

star 

TRACKER 2 VERT. 

(KM) 

7 

GPT 

X POSITION 

(KM) 

8 

GPS 

Y POSITION 

(KM) 

9 

GPS 

Z POSITION 

(KM) 

10 

GPS 

RSS POSITION 

(KM) 

1 1 

GPS 

X VELCCITY 

(KM/SEC) 

12 

GPS 

Y VELOCITY 

( KM/SEC 1 

13 

GPS 

Z VELOCITY 

(KM/SEC) 

14 

GPS 

RSS VELOCITY 

(KM/SEC) 


i i • i . i i j 

DATA XTIT/' TIME (SECONDS! */ 
OATA YTIT/’ UNITS (KM) ’ . 

‘ UN ITS ( KM/SEC . > ' , 

' UNITS ( ARC SEC. ) ' . 

* UNITS (RADIANS) V 
OATA XREF/' **♦ INERTIAL COORDIN 
' FLIGHT COOROiNAT 

OATA CTITLE /' NAVIGATION X POSI 
' NAVIGATION Y POSIT 
* NAVIGATION Z POSIT 


ATE FRAME ••• ' , 
E FRAME '/ 

TION ERROR 
ION ERROR 
ION ERROR 


ooooonooonoononoooon no 
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Page 


« navigation position error RSS 

' STANDARD DEV. X POSITION ERROR 
' STANDARD DEV. V POSITION ERROR 
' STANDARD DEV. Z POSITION ERROR 
1 STANDARO DEV. POSITION ERROR RSS 
1 NAVIGATION X VELOCITY ERROR 

' NAVIGATION Y VELOCITY ERROR 

1 NAVIGATION Z VELOCITY ERROR 

1 NAVIGATION VELOCITY ERROR RSS 

• STANDARD DEV. X VELOCITY ERROR 
1 STANDARD DEV. Y VELOCITY ERROR 
' STANDARD DEV. Z VELOCITY ERROR 

' STANDARO DEV. VELOCITY ERROR RSS 
1 ATTITUD ERROR ROLL 

• ATTITUD ERROR PITCH 
' ATTITUD ERROR YAW 

' ATTITUD ERROR RSS 
' STANDARD DEV. ATTITUDE ERROR ROLL 
1 STANDARO DEV. ATTITUDE ERROR PITCH 
' STANDARO DEV. ATTITUDE ERROR YAW 
' STANDARD DEV. ATTITUDE ERROR RSS 
' L.M. TRACKER RESIDUAL HORIZONTAL 
' L.M. TRACKER RESIDUAL VERTICAL 
' STAR TRACKER 1 RESIDUAL HORIZONTAL 
' STAR TRACKER 1 RESIDUAL VERTICAL 
1 STAR TRACKER 2 RESIDUAL HORIZONTAL 
' STAR TRACKER 2 RESIDUAL VERTICAL 
' GPS X POSITION RESIDUAL 
' GPS V POSITION RESIDUAL 

' GPS Z POSITION RESIDUAL 

' GPS RSS POSITION RESIDUAL 

• GPS X V.LOCITY RESIDUAL 

• GPS Y V LOCITY RESIDUAL 

• GPS Z V LOCITY RESIDUAL 

' GPS RSS VELOCITY RESIDUAL 


DEFINITION OF X 

X ( 1.1) 

X( 1,2-4) 

X( I .5-7) 

X( 1,8-11 ) 

X( 1,12-14) 

X( 1,15-17) 

X ( 1,18-21 ) 

X< 1 22-23) 

X ( 1,24-25) 

X ( 1,26-27) 

X( 1,28-30) 

X( I ,31-33) 

X( n ,n , 1 ) 

X ( n,o,2) 


* 


T IME 

X.Y.Z POSITION ERRORS 
X , Y , Z VELOCITY ERRORS 
QUATERNION ATTITUDE ERRORS 
STANDARD DEV. X.Y.Z POSITION ERRORS 
STANDARD DEV. X.Y.Z VELOCITY ERRORS 
STANOARD DEV. QUATERNION ATTITUDE ERRORS 
L.M. HORZ..VERT. RESIDUALS 
STAR TRACKER 1 HORZ ■ ■ VERT . RESIDUALS 
STAR TRACKER 2 HORZ., VERT. RESIDUALS 
GPS X.Y.Z POSITION RESIDUALS 
GPS X.Y.Z VELOCITY RESIDUALS 
COORDINATES IN INEPT I AL FRAME 
COORDINATES IN FLIGHT FRAME 


GCPPLOTSMAIN 


16-Apr-1901 08:34:04 
16-Apr-19B1 OB '• 32 : 1 6 


VAX-11 FORTRAN V2.0-2 
OBAO t [ D 1 1 R • OOP ]GCPP LOT . FOR 1 92 


0026 

0027 


0028 

0029 

0030 

0031 

0032 

0033 

0034 

0035 

0036 

0037 
003B 


> 

i 


0039 

0040 

0041 

0042 

0043 

0044 


0045 

0046 

0047 

0048 


0049 

0050 

0051 
006 * 


C 

c 

c 

c- 

c 

c 

c- 

c 


— START PLOTS 


c 

c- 

c 


10 


20 


2 

c 

c- 

c 


— get output plotting device type 

MR ITE(5. 908) 

RE A0( 5 ,903 ) AOT YPE 

- OPEN input DATA FILE AND READ the PLOT TITLE 

OP EN( UN I T *2 . NAME* 'PLOT .DAT 1 .TYPE*' OLD ' , RECORDSIZE* 780 ) 
READ(2,907)(ATIT(I). 1*1.64) 

I* 1 

CONTINUE . , , , 

RE ADI 2 .900 .END *20) ( X ( I ,U . ' ) . U* 1 > 39 ) 

1*1*1 
GO TO 10 
CONTINUE 
INUM=I-1 

MR I TE ( 5 , 2 ) INUM . 

FORMAT ( 1 TOTAL POINTS REAO IN • 

— WRITE OUT FIRST MENU 

WRITE (5. 901) (MENUS! I .D.I*’ .23) 

MR I TE ( 5 , 9 1 2 ) 

MR ITE<5, 913) 

R£A0(5,903)AFR AME( 1 ) 

MR ITE(5, 914) 

RE A0(5.903)AFRAME(2) 


.14) 


C 

C — 
C 


SET UP FLIGHT COORDINATE SIDE OF X IF NECESSARY 


25 

C 

C- 

C 

30 


C 

c- 


I F ( AFRAME ( 2 ) ■ N E • 1 Y 1 ) GO TO 25 
WRITEf 5.915) 

CALL I NEFLT 
CONTINUE 

— PUT UP SECOND MENU 

CONTINUE . 

MR I TE( 5. 901) (MENUS! I ,21,1*1.23) 

MR l T E ( 5 . 904 ) 

RE A0( 5.905JITYPE 

ERROR CHECK ON I TYPE 


0053 

c 

IF < ITYPE . cQ. "I )G0 TO 9999 

0054 

0055 

0056 

0057 

0058 

c 

IFdTYPE.GT.O.ANO. ITYPE . LE . 4 )G0 TO 35 
MR I T E ( 5 , 92 0 ) ABE L LS 
MR! TE!5,902 ) 

REAO ( 5 , 903 ) ATYPE 
GO TO 30 
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0059 

35 

CONT INUE 


C 

PUT UP CORRECT MENU. AND REC I EVE OPTION(S) 


C“*** 

r 

0060 

w 

40 

CONTINUE 

0061 


MR ITE15. 901 ) (MENUS( I , ITYPE+2 ) . 1 * 1 . 23 ) 

0062 


MR I T E( 5 . 906 ) 

0063 


RE ADI 5.905 )( IOPTS( 11.1*1.4) 

0064 

43 

CONTINUE 

0065 


IF ( ITYPE.EQ.3. OR . AFR AME ( 2 1 . NE . 1 V 1 )GO TO 45 

0066 


WRITE! 5, j16) 

0067 


READ! 5.917)1 FRAME 

0068 


I F ( I FRAME . LT . 1 .OR. I FRAME . GT . 2 ) GO TO 43 

0069 

45 

CONTINUE 


c 

c — 

ERROR CHECK IOPT 

0070 

c 

00 60 1*1.4 

0071 


IFUOPTSI I ) .GE.O.ANO.IOPTS(I) . LE . IMAX( ITYPE) )GO TC 

0072 


MR IT El 5. 920) ABELLS 

0073 


WRITEI5.902) 

0074 


READ! 5.903 ) 

0075 


GO TO 40 

0076 

50 

CONTINUE 

0077 

60 

CONTINUE 


C 

oetermine the number of plot OVERLAYS 

Of 78 

c 

I T OT *0 

Of. 7 9 


DO 70 1*1.4 

0. 80 


I F ( IOPTSd ) .NE.OJI T0T«IT0T*1 

0081 

70 

CONTINUE 


c 

c 

oetermine thl plots UNITS 

0082 

w 

1 UNI T* 1 

0083 


: F ( ITYPE -E0.2 ) IUNIT* 2 

0084 


! 1 { ITVPE .EQ.3 ) IUNIT. 3 


c 

if this is a residual plot, check for units conformity 


c 

CHECK FOR EMBEDDED ZERO IN OPTION STRING 

0085 

c 

IF (IT0T.E0.4IG0 TO 68 

0086 


DO 65 I * I TOT *1 ,4 

0087 


1 F ( I OPTS ( I ) • EQ . 0 )G0 TO 63 

0088 


MRITEI5. 922)ABELLS 

0089 


MR I TE( 5 . 902) 

0090 


READ(5.903)ATYP- 

0091 


GO TO 40 

0092 

63 

CONTINUE 

0093 

65 

CONT INUE 

0094 

66 

CONTINUE 

0095 

C 

IERR-0 

0096 


I F ( I T YPE . NE . 4 ) GO TO 80 

0097 


IT-1 
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0098 

0099 

0100 
0101 
0102 

0103 

0104 

0105 

0106 

0107 

0108 
0103 
0110 
Oil 1 
0112 
01 13 
01 14 
01 15 
0116 

0117 

01 18 

0119 

0120 


0121 
0122 
> 0123 

i 0124 

0125 

0126 

0127 

0128 
0129 


0130 

0131 

0132 

0133 

0134 

0135 

0136 

0137 

0138 

0139 

0140 


0141 

0142 


73 

75 

77 

78 
80 


90 

C 

C 

C 

C 

c— - 
c 

100 


110 


c 

c- 

c 


16-Apr-1 981 

IF( IOPTS! 1 > . GT.10) IT«2 
IP( 17. EQ.2IG0 TO 75 
DO 7 3 I* 1 . HOT 

IF(IOPTS(I).GT.10)IERP=1 

CONTINUE 

I UN I T«1 
GO TO 7B 
CONTINUE 
DO 7 7 1*1,1 TOT 

IF(I0PTSU).LT.tt)IERR*1 
CONTINUE 
I UN I T = 2 
CONTINUE 
CONTINUE 

WRITE^sfi^UNI T^" ( ‘ * 1 ) • E<J . 1 . OR . I0PTS{1 ) . £0 >2)1 IUN I T »4 

PORMAT(' I UN I T * '.110) 

IF t I ERR . EQ.OIGO TO 90 
WRITE! 5.921 ) ABELLS 
WR1 TE( 5.902 ) 

READ! 5 , 903 ) A TYPE 
GO TO 40 
CONTINUE 

EVERT THING CHECKS OUT GOOD SO FAR 

GET THE TIME FRAME USED FOR THIS PLOT 
CONTINUE 

j*R I TE ( 5 . 909) All, 1,1), x( INuM ,1.1) 

RE AD(5.910)RSTART.RST0P 
IF(R$TART.LT.R STOP) GO TO 110 
WRITE! 5.91 1 ) 

GO TO 100 
CONTINUE 

IF(RSTOP.GT.X( INUM.1 ,1))R S T0P.X( I hum 1 11 
I F ( RSTART . LT. X ( 1 . 1 . , , , RST ART*X( , , > 

GET THE BOUNOS ON THE TIMES 
00 120 1=1, INUM— 1 


120 

CONTINUE 

130 

CONTINUE 


ITSTRT*I 


DO 140 1*1 


ifirstop 

140 

CONTINUE 

150 

CONTINUE 


I T STOP* I+i 


I T NUM* I TSTOP- 1 T STRT + 1 

SET UP TIME ARRAY 

00 160 1*1 , ITNUM 

TIME! I )-X( •♦ITSTRT-1 ,1. 1 ) 


08:34:04 

08:32:16 
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P«0« 7 


0143 


0144 

0145 

0146 


ho 


0181 

0182 

0183 


160 
C*< « 

c 

c • • < 

c 

c 

c 


CONTINUE 

CREATE THE PLOTS 


C 

C 

C 

C 


INITIALIZE THE PLOTTING OEVICE 

IF (AOTYPE.EO. ' T* )GO TO 170 
CALL HP7221 
CALL QQHP(0. ,0. ,6) 


I FIRST ARG IS PEN TYPE 


0147 


GO TO 180 

0148 

170 

CONTINUE 

0149 


CALL Tk 

0150 

180 

CONT INUE 

0151 


CA LL PAGE ( 8.5, 11.) 

0152 


CA LL PHYSOR! 1.5,1.) 

0153 

c 

CALL TITLE! ' ' , 1 , AXT I T 


c 

PUT UP TITLE and legend 


0. 
1 . 
2. 
3. 


BLACK 

RED 

blue 

GREEN 


0154 

0155 

0156 


0157 

0158 

0159 

0160 
0161 
0162 

0163 

0164 

828 

0165 

0166 
0167 

182 

0168 

0169 

0170 

184 

0171 

0172 

0173 

186 

0174 

0175 

188 

0176 

0177 

189 

0178 

0179 

0180 

190 


CALL HEIGHT! .20) 

CALL MESSAG! AT I T . 40 . 0. .9.7 ) 

NR I T E ( 5 . 828 ) I F RAME 
FORMAT! ' I FRAME « ' , 16) 

CALL MESSAG(AREF((IF RAME- 1 ) *40*1 ) , 40,0. ,9.4) 

CA LL HEIGHT! .15) 

DO 190 I*l,ITOT 

I TEMP* I OFF( I TYPE)* I0PT5! I ) 

IF( AOTYPE.EO. ' H* )C A LL QQHP( FLOAT ( I~1 1,0., 6) 

G0^T 0 **( ^82?! 84 1 188 ! 1 88 ^ ( I~1) • .25) 

CONTINUE 

CALL RESET{'OOT‘) 

GO TO 189 
CONTINUE 
CALL DASH 
GO TO 189 
CONTINUE 
CALL DOT 
GO TO 189 
CONTINUE 
CALL CHNOOT 
CONTINUE 

cSiTINSE TOR<0 ' ,9 '‘ (I- ”*’ 25+,08,1 - 5,9 -" lI " ,, *- a5 ^ 08l0 > 

CALL RESET! ’ CHNDOT 1 ) 

CALL OOHPIO. .0. ,6) 

PROCESS CURVES NOW. STOR- VALUES INTO YARRAY 

DO 600 I *1,1 TOT 

IPTR*IOFF( ITYPE)+IOPTS( I ) 

ITEMP-IOPTOF! IPTR) 
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C 

C 

C 

0184 


0185 200 

C 

c 

c 

0188 

0187 

0188 210 

0189 

0190 240 

C 

C 

c 

0191 

0192 


0193 250 

0194 

0195 300 

C 

c 

c 

0198 

0197 

0198 310 

0199 

0200 340 
C 

C — 
C 

0201 
0202 


0203 350 

0204 500 

0205 600 
C 

c 

c 

0206 

0207 

0208 

0209 

0210 
0211 

0212 650 

0213 700 
C 


GO TO THE PROPER OPTION 

GO TO (200, 200 ,200 . 240. 200 ,200 , 200 . 240,200 , 200,200 ,24' , 

• 200,2 00,200 , 240.300 , 300 , 300,340,300 , 300 • 300,340 , 

• 200.200,200 .200.200,200 .200,200,200,240,200,200 , 

• 200 ,240 ) I PT R 
CONTINUE 

PLOTS REQUIRING NO TRANSLATION OF DATA 
DO 210 d*1 .ITNUM 

YARRAVI ( 1-1 )*3000*d)*X(d*ITSTRT-1 . ITEMP. I FRAME I 
CONTINUE 
GO TO 500 
CONTINUE 

RSS PLOTS REQUIRING NO TRANSLATION OF DATA 
DO 250 J * 1 , I TNUM 

YARR At ( ( 1-1 ) *3000*0 ) *SQRT (X( d+ITSTRT-1 , I T EMP , I FRAME ) * *2+ 

• X( d+ITSTRT-1 . ITEMP-H , IFRAME)**2+ 

• X(d*lTSTRT-1 ,ITEMP*2, IFRAME)**2) 
CONT INUE 

GO TO 500 
CONTINUE 

ATTITUDE ERRORS. CONVERT TO ARC SECONDS. 

DO 310 d*1 , 1 TNUM 

YARRAY(< 1-1 )«3000*dI*(X( J+ITSTRT-1 , 1 TEMP , I FRAME ) *2 . ) / . 4B48E-5 
CONTINUE 
GO TO 500 
CONTINUE 

ATTITUDE RSS 

DO 350 d*1 , I TNUM 

YARR AY (( I-1)*3000+d)*( 2.*SQRT(X(d*ITSTRT-1 .ITEMP, I FRAME)** 2* 

• X < d+ 1 T STRT- 1 , I TEMP* 1 , 1 FRAME ) •• 2* 

• X ( J* I T STRT- 1 , IT£MP+2,IFRAME)**2)) 

• /.4848E-5 
CONT INUE 

CONTINUE 

CONTINUE 

FIND MIN ANO MAX. 

RM AX *-30 0000000. 

RM INOOOOOOOOO . 

DO 700 I *1,1 TOT 
DO 650 d* 1 . I TNUM 

IF(Y ARRAY! (1-1 )*3000*d > . LT . RMIN) RM IN* YARRAY ( ( I - 1 ) * 30 00*d > 

I F ( Y ARRA Y ( ( 1-1 ) • 3000*d ) . GT . RMAX ) RMAX-V ARRAY ( ( I - 1 ) * 30 00*d ) 
CONTINUE 
CONTINUE 
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0214 

0215 


C 

C 


c 

c 

c 


0216 

0217 

0218 

0219 

710 

0220 

0221 

0222 

720 

0223 

0224 

0225 

730 

0226 

0227 

0228 

740 

0229 

0230 

750 

0231 

0232 

800 

0233 

0234 

0235 

9999 

0236 

900 

0237 

901 

0238 

902 

0239 

903 

0240 

904 

0241 

9C5 

0742 

906 

0243 

907 

0244 

908 

024$ 

909 

0246 

910 

0247 

91 1 

0248 

912 

0249 

913 

0250 

914 

0251 

915 

0252 

916 

0253 

917 

0254 

920 

0255 

921 

0256 

922 


PLOT GRIO ANO AXIS 

CALL GRIOIO^) <,), SC * LE ’ TIME(,TNy * ,, * RI ' l, ‘' 


'SCALE' ,fWAX) 


DRAM CURVES 

00 800 1=1 ,ITOT 

CALL QOHP) FLOAT) I- 1 ) ,0. . 6) 

GO TO (710.720.730,740)1 
CONTINUE 

CALL RESET ( • OOt 1 ) 

GO TO 750 

continue 
call DASH 
GO TO 750 
CONTINUE 
-ALL OOT 
GO TO 750 
CONTINUE 
CALL CMNDOT 
CONTINUE 

rn«r.^Mc VE(TI “ E,V * ,,RAV( ' 1-1 >*3000*1 ) .ITNUM.O) 

V-UN T I NUt 

CALL ENDPL(O) 

GO TO 30 
CONT INUE 
FORMAT) 39E20. 10) 

FORMAT) A64) 

FORMAT) I*.- H (t RETURN to continue 
FORMAT) A1 ) 

FORMAT) • OPTION » • , S) 

FORMAT (4 14) 

FORMAT) ' OPT ION) S) >> • .*) 

F0RMAT(64A1 ) 

FORMAT (' PLOTTER TYPE (T OR H) : 

FORMAT)' INPUT START, STOP TIMES FOR THE PLOTS. ' / 

' ' MIN. MAX TIM S ARE : ' , 2 ( F6 . 1 2X ) ' TIMES 

F 0 RMA T ( 2 F 6 . 1 ) ' ' * t5 

FORMAT) ' BAD START, STOP TIMES. START MUST BE LESS THEN STOP'l 
Fn ruat ! • ,WPUT " E ^RENCE FRAMES PLOTS MILL BE GENERATED IN : ' ) 


• *) 


.*) 


'•*) 


FORMAT) • 
FORMAT) ' 
FORMAT) • 


\S> 

'.S> 


0257 


INERTIAL COORDINATES (Y OR N) 

FLIGHT COORDINATES <V 08 N) 

... one moment pleas* ') 

FORMAT) ' REFERENCE FRAME TYPE FOR PLOT ' / 

1 INERTIAL . 1 './, 

' FLIGHT . 2 ',/, ‘ 

* REFERNCE TVP : • ,$) 

FORMAT(II) 

FORMAT)////////////, ■ INVALID OPTION TYPE 10A1 , 11 / 11 / 11 // ) 
FORMAT)////////////, • ILLEGAL MIXING OF UNITS 1 0A 1 ,//// ////// 
FO RMAT ( / ////// /////^ ^/ILLEGAL EMBEDDED ZERO IN OPT lON^STRING^f 

END 


VAX-11 FORTRAN V2.0-2 

-DBAO: [ D 1 1 R. GC P ] GCPPLOT . FOR; 92 


GCPPLOty 


Pa v - 10 


16-.^ -1981 08:34:04 
16-Apr-1981 08:33:16 


VAX-11 FORTRAN V2.0-2 
_0BA0:[D11R.GCP]GCPPL0T.F0R;92 


PROGRAM sections 



Nam* 

Bytes 

At t r i but*S 







0 

SCOOE 

2990 

PIC CON REL 

LCl 

SHR 

EXE 

RO 

NONRT 

LONG 

1 

SPOATA 

878 

PIC CON REL 

LCL 

SHR 

NOEXE 

RD 

NOMRT 

LONG 

2 

(LOCAL 

71544 

PIC CON REL 

LCL 

NOSMR 

NOEXE 

RO 

MRT 

LONG 

3 

ARRAY 

936003 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RO 

NRT 

LONG 


ENTRY POINTS 

Address Type Nam* 
0-00000090 GCPPIOTSMAIN 


VARIABLES 


Address 

Type 

Nam* 

Address 

Typ* 

Nam* 

3-00011581 

L* 1 

AOTYPE 

2-0001 1 580 

L * 1 

ATYPE 

2-0001 15B4 

1*2 

I FRAME 

3 — 000E4 840 

1 *2 

INUM 

3-0001 15E4 

1*4 

ITENP 

2-0001 15E0 

1*4 

ITNUM 

2-0001 1508 

1*4 

ITSTRT 

2-00011 582 

1*2 

ITVPE 

2-0001 1 5EC 

R*4 

RMAX 

2-0001 1 5F0 

R *4 

RM IN 

2-0000080C 

CHAR 

XT I T 





ARRAYS 

Address 

Type 

Name 

Bytes 

Dimensions 

2-0001 1564 

L* 1 

ABELLS 

10 

(10) 

2-0001 1 5AE 

L* 1 

AFRAME 

2 

(2) 

2-00000000 

L* 1 

AREF 

80 

(80) 

2-0001 156E 

L* 1 

ATIT 

64 

(64) 

3-00000050 

L* 1 

ATITLE 

1900 

(1900) 

2-00 Oi'OBOC 

L* 1 

AXT IT 

20 

(20) 

3-00 U007BC 

L* 1 

AYTIT 

80 

(80) 

2-00000050 

CHAR 

CTITLE 

1900 

(38) 

3-00 OOF 288 

1*3 

IMAX 

8 

(4) 

2-0000F290 

1*2 

IOFF 

8 

(4) 

2-00 OOF 298 

1*2 

IOPTOF 

76 

(38) 

3-0000F280 

1*2 

I0PTS 

8 

(4) 

2-0000F2E4 

CHAR 

MENUS 

8832 

(23. 6) 

2-00000820 

R*4 

TIME 

12000 

(3000) 

3-00000000 

R*4 

X 

936000 

<3000. 39. 2) 

3-00000000 

R*4 

XI 

468000 

(3000. 39) 

3-00072420 

R*4 

X2 

468000 

(3000. 3B) 

2-oooaoooo 

CHAR 

XREF 

80 

(2) 

3-00003700 

R*4 

VARRAV 

480 OC 

< 1 2000) 

2— OOOOOTBC 

CHAR 

YTIT 

80 

(4) 


Address 

Type 

Name 

2-0001 15B8 

1*4 

I 

2-0001 15E8 

1*4 

IPTR 

2-0001 1SC0 

1*4 

ITOT 

2-0001 15C4 

1*4 

IUN1T 

2-0001 1500 

R*4 

RSTART 


Address 

Type 

Name 

2-0001 15C8 

1*4 

IERR 

2-0001 15CC 

1*4 

IT 

2-0001 150C 

1*4 

IT STOP 

2-0001 1 SBC 

1*4 

a 

2-00011504 

R*4 

RSTOP 




— - *- 


gcpplo'imain 




LABELS 

Adiires s 

Lao* 1 

Aridr OSS 

L »oe 

1-00000010 

1 • 

1 -000C 0000 

2 ' 

0-00 0002 A9 

35 

o-oorc 02A9 

40 

0—00 00048E 

63 

• . 

65 

* • 

77 

O-CDJ304F0 

76 

• » 

120 

0-00C0064F 

1 3C 

0-00 000600 

ISO 

0-000C 07EB 

1 82 

• * 

190 

0-000008DF 

200 

• • 

310 

O-OOCOOAO? 

340 

• • 

700 

0-00000856 

710 

• * 

BOO 

1 -0000 002 A 

828 ' 

1-00000063 

904 ' 

1-00000072 

905' 

1-00000104 

910' 

1 -0000 0 1 CA 

91 1 • 

1-OOOCOI F2 

916 ' 

1-00000258 

9 17* 


FUNCTIONS ANO 

SUBROUTINES 

REFERENCED 

CMNOOT 

CURVE 

DASH 

HEIGHT 

HP 7 221 

INEFLT 

RESET 

T I T LE 

TK 


Total Space Allocated • 101141 4 Bytes 


1 6"Apr - 1 96 I 08:34:04 

16-Apr-198l 08:32:16 


Address 

Label 

Address 

Labe 1 

0-00000076 

10 

0-00000080 

20 

0-000003 2E 

43 

0-00000380 

45 

0-00000492 

68 

• • 

70 

0-000004F4 

80 

0-00000589 

90 

• * 

140 

0-00000685 

150 

0-00000 7 F6 

184 

0-00 0007 F F 

1 86 

« • 

210 

0-00 00092E 

240 

• • 

350 

0-00 000ABD 

500 

C-OOOOOB61 

720 

0-0000086A 

730 

1-00000039 

900 1 

1-0000003F 

901 ' 

1-00000077 

906’ 

1-00000089 

907 ' 

1-00000140 

912' 

1-00000177 

913' 

1 - 000002 5B 

920‘ 

1-0000028D 

921 ' 

DOT 

MESSAG 

vector 

ENDPL 

MTHSSQRT 

FORSCPEN 

PAGE 


VAX-11 FORTRAN V2.C-2 R a ge 11 

_D8A0: [01 1R.GCP JGCPPLOT. FOR; 92 


Address 

Labe 1 

Addr •?% 

Label 

O-OOOC 0 1 C9 

25 

0-000001 C9 

30 

0-000003CA 

50 

a a 

60 

* • 

73 

0- 0000 04 C F 

75 

0-00000590 

1 00 

0-0000060A 

110 

• * 

•60 

0-00000606 

170 

0-00000008 

188 

O-OOOOOBOF 

189 

• • 

250 

0- 000009 A F 

300 

• • 

6C0 

• • 

650 

0-00000873 

740 

0— 00000B7A 

750 

1 -00000042 

902" 

1-00000060 

903' 

1-0000000E 

908’ 

1 — OOOOOOAB 

909' 

1— 000001 A3 

914' 

1-000001 CF 

915' 

1-000002C2 

922' 

0- OOOOOBAA 

9939 


GRAF 

GRID 

PHYSOR 

OQHP 


COWAND QUA l If IERS 

FORTRAN /LIS/CO: 77 GCPF LOT 

/CH£ CK« ( NO BOUNDS .OVERT LOW) 

/DEBUG* < NOSYMBOL S . TRAC E BACK ) 

/E77 /NOG _ FLOAT ING / 1 4 /OPTIMISE /saRn.nGS 


COMPILATION STATISTICS 


Run 1 i m* : 

E I ap sed Tima: 
Pag# Faulta: 
Dynamic Memory : 


9.48 seconds 
54 . 60 second* 
592 

143 pages 


/NOD.LINES 


/NOMACHI NE_C00E /CONT INOAT 1 0NS«77 


8~ Apr- i 98 1 07:42:20 VAX-11 FOP'RAN .7 0-2 

S-Apr-1 981 07:40:46 _OBAO : [ 0 1 1 R • GC ►* i INEF L T . FOB ; 1 0 


000 ’ 


0002 


0003 

0004 
0003 
0006 

0007 

0006 


c 

c — 

c 

c 

c 


subroutine ineflt 

this routine tranforms thin is in a fro* inertial .0 flight 

INCLUDE 'ARRAY , COM ’ 

COMMON BLOC". USEO FOR PLOTTING ROUTINE 

COMMON /ARRAY/ X ( 300 0 . 39 . 2 I . INCM 
RE 4L*4 X . X 1 ( 3000 .39 ( x2i3C0C.39) 

integero inum . , , ,,, 

EOUIVALENCE 1X1(1.11 .AI1.1*' 

RE AL*8 X TRANS 1 3,3.30 00 1. XTRANPO .3.3000) 

REAL*e XTEMP1 ( 31 .XTEMP2I 3 ) 


C 

C 

c 

c 


CREATE TRANFORMAT ION ARRAYS 


000* 


CALL TRANFMl XT RANS . X TR 


c 

c 

TRANSFER THINGS IN X THAT 

0C10 

c 

DO 10 b 1 . INUM 

001 1 


X| I . 1 . 2>*X< I . 1 .1 1 

0012 


X ( ! . 1 8 . 2 ) <■ * ( 1.18.1 1 

0013 


X',T.19.2)«X< 1.19.1 1 

0014 


X( 1 .20 ,2I«X( I .20. 1 1 

0013 


X( 1 .21 .2)*X( 1.21.1 ) 

0016 


X< I .22 ,21*X( 1.22.1 1 

00 1 T 


XI I .23 . 2 l»X( 1.23.1 1 

00 1 8 


X ( I . 24 . 2 I - X ( I .24. 1 1 

0019 


X( 1 .25 .2 1«X( 1.25.1 ) 

0020 


XI 1.26. 2)*X< 1.26.1 1 

0021 


XI I .27 ,2I*X( 1.27.1 ) 

0022 

10 

CONTINUE 


CREATE TRANSFORMED ER i IS 


0023 


DQ 20 1*1.1 NUM 

0024 


X TEMPI (t)*X< 1.2.1) 

0 25 


XTEMP1 ( 2 1 * X 1 1.3.1) 

0026 


XTEMP1 ( 3 1 * * I 1.4,1) 

0027 


call crtrani xtrans 

0028 


X( I . 2 . 2 1 * X T E MP2 I 1 1 

0029 


XI I . 3 . 2 1 * 7. T E MP2 1 2 1 

0030 


XI I . 4 , 2 1 * X T EMP2I 3 ) 

0031 


XTEMP1 ( 1 ) « X i 1.5.1) 

0032 


XTEMP1 ( 2)*X( 1,6.1) 

0033 


xtempi 1 3 ) * X ( 1.7.1) 

0034 


call crtrani xtrans 

0035 


X( I .5. 2)«XTE«*P2( 1 ) 

003 r 


X( 1 .6.2 ) *XTEMP2( 2 ) 

0037 


X I l , 7 . 2 ) *XT EMP2I 3 ) 

0038 

20 

CONTINUE 


CREATE RESIDUALS TRANSFORMED 


COORDINATES. 


Pro* • 


INEFLT 


8-Apr-1981 07:42:20 
S-Apr-1981 0’:40:46 


VAX-11 FORTRAN V2.0-2 
_DBAO*. [D1 1R.GCP]lNEFl- T 


0039 

C 

c 

c 

c 

0040 30 

0041 

0042 


00 30 1*1. INUM 

CALL CRESIFt XTRANS (1.1, 
CALL CRESI F ( XTRANS ( 1 . 1 
CALL CRESI E ( XTRANS (1.1 
CALL CRESI F ( XTRANS (1.1 
CONTINUE 
RETURN 
END 


12.1 ) . XTRANP ( 1 .1 , I) .X(I . 12.2) 1 
I ) ai i, 15.1 ) . XTRANP (1,1.1) • }5.2n 
I ) , X( I . 28. 1 ) . XTRANP ( 1 . 1 . 1 > . *< I . 20 . 2) ) 
X),X(I,31.1). XT«ANP( 1 ,t.I).X(I.3i,2)) 


I ) . X ( 1 
I).X(1 


PROGRAM SECT IONS 

Name 

0 $CC;OC 
7 Al 

3 APRaw 


Bytes Attributes 


350 PIC CON 
432080 PIC CON 
936002 PIC OVH 


REL LCL SHR EXE 
REL LCL NOSHR NOEXE 
REL GBL SHR NOEXE 


RD NQWRT LONG 
RO WRT QUAD 
RD WRT LONG 


• N 1 H v POINTS 


Add-ess Type 

Name 


0-00000000 

INEFLT 


VAR I AB 1 FS 



Add-ess Type 

Name 

Address 

2-00069700 1*4 

I 

3-OO0E434O 

ARRAYS 



Address Type 

Name 

Bytes 

3-00 OC 0000 R I 

3—00 OC jOOO R*4 
3-00072470 R*4 

2-00069780 R*8 

2-00069798 R* B 
2-00034BCO R*8 

2— CO 000000 R*8 

X 

XI 
X3 

XTEMP1 

XTEMP2 

XTRANP 

XTSANS 

936000 

468000 

468000 

24 

54 

216000 

216000 


LABELS 

Address Label Addres* Label 


Type Name 
1*2 INUM 


Di mens i ons 


(3000, 39, 2) 
(3000, 39) 
(3000, 39) 

(3) 

(3) 

(3, 3, 3000) 
(3, 3, 3000) 


Address Label 
.. 30 


FOR 


INEFLT 


Page 3 



k 


8-Apr-1981 07:42:20 VAX-11 FORTRAN V2.0-2 
S-Apr-1 981 07:40:46 _DBAO: [D1 1R.GCP] INEFLT .FOR ; 10 


FUNCTIONS AND SUBROUTINES REFERENCED 
CRTRAN TRANFM 

Total Space Allocated • 1368432 Bytas 


COMMAND QUALIFIERS 

FORTRAN /LIS iNEFLT 

/CHECK* ( NOBOUNOS .OVERFLOW) 

/DEBUG* ( NOSVMBOL S . TRAC E BACK ) 

/ F77 /nog floating /I4 /OPTIMIZE /WARNINGS /NOD.LINES /NOMACHINE.CODE /CONT INUATI 0NS» 1 9 


COMPILATION STATISTICS 

Run Time: 1.46 seconds 

Elapsed Tims: 3. SO seconds 

Page Fau Its: 166 

Oynamic Memory: 51 pages 


I 


f 


b 


i 










niMaMJin n mnJiaWfti 




ROGCP 





TRUE* . - 
OCCULT 


MAT AB , ~ 


! ! ! 1 ! I I I I I 1 111 I I i 




'W TJ 




6 “ Apr ~ 1901 14:50:97 VAX-11 FORTRAN .2.0-2 

30-Seo-l 900 00 : 06:45 _DBA0 : [ D 1 i R .GC^ ]MI V/3 . FOR : 5 


Page 1 


octeo 

0001 



subroutine min v3< x »s i 

0C 300 


c 


THIS SUBROUTINE TINUS The INVERSE OF * 3*3 MATRIX 

00500 

0002 



DIMENSION M3 3 ) .* INVRSf 3, 3) .TC0FACO, 3) .EL(4) 

00600 

0003 



REAf8 OET.SlGN.EL.TCClFAC.X.XINVRS 

0C700 


C- 

1 mmmu 


0CB00 


c 


FIND TRANSPOS of CCFACTOR MATRIX AND DETERMINANT 

00900 


c* 

> •••« 


01000 

0004 



SIGN « 1 .0 

01100 

0005 



DO 400 I«1.3 

01200 

0006 



DO 300 J * 1 . 3 

01300 

0007 



SIGN - -1 . 0*SIGN 

01400 

0008 



1COUNT - 1 

01500 

0009 



DO 200 1 1 - 1.3 

01600 

0010 



DO 200 JJ - 1.3 

01 7C0 

001 1 



IF 1 I I . EQ. I . OR. JJ. EO . d) GO TO 200 

oieoo 

0012 



EM ICOUNT) = XIII.J.J) 

01900 

0013 



ICOUNT * ICOUNT ♦ 1 

02000 

0014 


200 

CONTINUE 

02 1 00 

0015 


300 

TCOFAC(J.I) = SIGN*( EL{ 1 )»EL(4)-EL(3 )»EL I 2) ) 

02200 

0016 


400 

CONTINUE 

02300 


c« 

» • ••< 


02400 


c 


fino determinant 

02500 


c< 

1 •••< 


02600 

0017 



DET • X( 1 . 1 )-TCOFAC( 1 , 1 ) ♦ X(2, 1 )-TCOFAC(1 .2) + X ( 3 . 1 ) • TCOFAC (1 , 3 ) 

02700 


c« 

» • • + > 


02800 


c 


INVERSE - (TRANSPOSE OF COFACTOR MATRIX) /DETERM I NANT 

02900 


c« 

r •••* 


03000 

0018 



DO 500 1 -1,3 

03100 

0019 



DO 500 d - 1 .3 

03200 

0020 


500 

XINVRSU.d) ■ TC0FAC( I , Jl/DET 

03300 


c 



03400 

0021 



RETURN 

03S00 

0022 



END 



A-336 


MINV3 

PROGRAM SECTIONS 


2-00000048 R*0 EL 

2-00000000 R»8 T COE AC 

AP— 00 000004# R«8 A 
AP-00 000008* R*S RINVRS 


6-Apr-1 981 14:50:37 
30 _ Sep - 1 980 08:06:45 


WAX-11 FORTRAN W2.0-2 
_DBA0: [0 t 1R.GCP]MINV3. FOR; 5 


p«o« 


Name 



Bytes 

At t r i butes 





0 scoot 

2 SLOCAL 



213 

PIC CON 

REL 

LCL 

SHR EXE 

RO NOMRT LONG 



184 

PIC CON 

REL 

LCL 

NOSHR NOEXE 

RD 

WRT QUAD 

ENTRY POINTS 










Address 

Type 

Name 








0-00000000 


MINV3 








VARIABLES 










Address 

Type 

Name 

Address 

Type Nam# 



Address 

Type 

Name 

2-00000068 
2—00 O0007C 

R*8 

I«4 

OET 

J 

2-00000078 

2-00000008 

I *4 1 

1*4 JJ 



2-00000080 

2-00000070 

I»4 

R*8 

I COUNT 
SIGN 

ARRAYS 










Address 

Type 

Name 

Bytes 

0 1 mens 1 ons 







32 

72 

72 

72 


(4) 

(3. 3) 
(3. 3) 
(3. 3) 


Address Type Name 
2-00000084 1*4 II 


LABELS 

Address Labe 1 
0-00 000059 200 


Address Label 
• • 300 


Address Label 
• • 400 


Address Label 
• • 500 


Total Space Allocated • 397 Bytes 
command qualifiers 

fortran /LIST GCP. INOATA. MAT AB, OUT DATA. RUNG. ON AW . EPHEM . TRUEA, SPRESS . OCCULT, GPERT .GCPSEQ. VISIBLE .CENENV .TREG.GYROUT . RATE. BMAT.CMA 
/CHECK. (NO BOUNDS .OVERFLOW) 

/F77 U **/NOG^f1!oAT *ng**/ 1 4* C /0 PT IMI 2 E /WARNINGS /NOO.LINES /NOMACHINE.CODE /CONT INUATIONS-19 


A- 3 37 


Page 3 


MINV3 


6“ Apr- 1 981 14:50:37 VAX-11 FORTRAN V2-0-2 
30-SPD-19S0 08:06:45 _DBA0: [D1 1R.GCP ]MINV3 . FOR ; 5 


COMPILATION STATISTICS 


Run T i me : 
Elapsed T lm»: 
Pag* fau its: 
Dynamic Memory: 


I . 08 seconds 

II. 19 seconds 

325 

160 pages 


A- 3 38 


3-Nov-1980 08 : 30: 54 
3 -Mov- 1980 08:30:21 


VAX-11 FORTRAN V2.0-2 
_DBB4: [B. OCR IP LOT . TOR 


0001 

0002 

0003 

0004 

0005 

0006 

0007 

0008 


0009 


0010 


TITLES! 26) 

AT IT ( 1040) . V T I T ( 1040 ) . ATYPE 

( A T 2 T ( 1 ) .TITLES* 1 ) )« (YTITlE(I).YTIT(I ) ) 

X ( 2000. 23) . TIME (2000) , Y AR AY ( 2000 ) . XF I L L ( 1 3 ) 


RE AL*4 RSTART.RSTOP 
Ch ARACT E R *62 M E NU 1(23) 
CHARACTER‘40 Y T I T LE ( 26 ) 
CHARACTER*40 

logical* 1 
equivalence 

RE AL*4 
DATA MENU 1 / 

• DISPLAY TYPES: 


• 1 

NAVIGATION ERROR 

X POS 

• 2 

NAVIGATION ERROR 

Y POS 

* 3 

NAVIGATION ERROR 

Z POS 

• 4 

NAVIGATION ERROR 

RSS POS 

' 5 

NAVIGATION ERROR 

X VEL. 

' 6 

NAVIGATION ERROR 

Y VEL. 

' 7 

NAVIGATION ERROR 

Z VEL. 

* a 

NAVIGATION ERROR 

RSS VEL 

* 9 

ATTITUDE ERROR 

roll 

' 1 0 

ATTITUOE ERROR 

PITCH 

• 1 1 

ATTITUOE ERROR 

YAW 

• 1 2 

ATTITUDE ERROR 

RSS 

* 1 3 

STAR TRACKER 1 RES 

. HORZ 

' 14 

STAR TRACKER 1 RES 

. VERT 

1 « 

,• REFERENCE FRAMES TYPES 

• 1 

EARTH FIX EO 


' 2 

inertial 



15 

STAR TRACKER 2 

RES. HORZ. 

16 

STAR TRACKER 2 

RES. VERT. 

17 

L.M. TRACKER RESID. HORZ. 

18 

L.M. TRACKER RESID. VERT. 

19 

GPS X POSITION 

RESID. 

20 

GPS V POSITION 

RESIO. 

21 

GPS 2 POSITION 

RESID. 

22 

GPS RSS POSITION RESID. 

23 

GPS X VELOCITY 

RESI D. 

24 

GPS V VELOCITY 

RESID. 

25 

GPS Z VELOCITY 

RESID. 

26 

GPS RSS VELOCITY RESID. 

-1 

EXIT 


. i 
• » 

■ * 

3 'ORBIT 

• 

• 


4 FLIGHT 

• 

* 


' V 

OATA YTITLE/' 


NAVIGATION 
NAVIGATION 
NAVIGATION 
NAVIGATION 
NAV1GA T ION 
NAVIGATION 
NAVIGATION 
NAVIGATION 

ATT I TUO 
ATTITUO 


OATA TITLES/ 


error 
error 

ERROR 
ERROR 
error 
error 
error 
error 

ERROR ROLL 
ERROR PITCH 


X POS (KM. ) * . 

Y POS (KM. ) ' , 

Z POS (KM. ) ' . 

RSS POS. (KM- ) ' . 

X VEL. (KM. /SEC. ) ' , 

Y VEL. (KM. /SEC.)* , 

Z VEL. (KM. /SEC.)' , 
RSS VEL. (KM. /SEC.)', 

(ARC SEC. )' . 

(ARC SEC. ) ' , 

(ARC SEC.)’, 

(ARC SEC. . 

(ARC SEC • ) 1 > 

(ARC SEC. ) ' . 

(ARC SEC.)'. 

(ARC SEC.)', 

RES. (ARC SEC.)' , 
RES. (ARC SEC.)', 
(KM.) '. 

( KM . ) ' , 

(KM.) '. 

POS RES I DI DUAL (KM.)' . 

L RESIDUAL (KM. /SEC.)', 

(KM. /SEC.)' . 

(KM. /SEC.)' , 

(KM. /SEC. ) '/ 

POS. vs. time ', 
POS. vs. time ' 
POS. vs. time 

ERROR VS. TIME ' 


ATTITUD ERROR YAM 
ATTITUO ERROR RSS 
S.T. 1 HORZ. RESIDUAL 
S.T. 1 VERT. 

S.T. 2 HORZ. 

S.T. 2 VERT. 

L.M. TRACKER 
L.M. TRACKER 
GPS X POS RESIDUAL 
GPS V POS RESIDUAL 


RESIDUAL 
RESIDUAL 
RESIDUAL 
HORZ. 
VERT . 


GPS Z POS RESIDUAL 
GPS RSS 
GPS X V 
GPS Y V L RESIDUAL 
GPS Z V .L RESIDUAL 
GPS RSS "EL RESID. 
NAVIGATION ERROR X 
NAVIGATION error Y 
NAVIGATION ERROR Z 
NAVIGATION RSS POS 


6 ££- 


PLOT SNA IN 


Pag* 


3-Nov-19B0 OB : 30: 54 
3-NOV-1980 08:30:21 


VAX-11 FORTRAN V2.0-2 
_DBB4: [ B . GCP ) P LOT . FOR ; 28 


C* 

c- 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

C' 

c 

c 


NAVIGATION ERROR X VEL. VS. TINE 

NAVIGATION ERROR V VEL. VS. TINE 

NAVIGATION ERROR Z VEL. VS. TINE 

NAVIGATION RL>S VEL. ERROR VS. TINE 

ATTITUD ERROR ROLL VS. TINE 

ATTITUD ERROR PITCH v S. TINE 
ATTITUD ERROR VA * VS . TINE 

ATTITUD ERROR RSS VS. TINE 

STAR TRACKER I HORZ. RES. VS. TIME 

STAR TRACKER 1 VERT. RES. VS. TIME 

STAR TRACKER 2 HORZ. RES. VS- T.NE 

STAR TRACKER 2 VERT. RES. VS . TINE 

LANDMARK TRACKER HORZ. RES. VEp- TIME 
LANDMARK TRACKER VERT. RES. VS. TINE 
GPS X POSITION RESIOUAL VS. TINE 
GPS V POSITION RESIOUAL VS. Tlfi.E 
1 GPS Z POSITION RESIDUAL VS. TIME 
1 GPS RSS POSITION RESIDUAL VS. TINE 
i GPS X V. LOCI TV RESIDUAL VS. TINE 

1 GPS V v locity residual vs. tine 

. GPS z V. LOCI TV RESIDUAL VS. TINE 

1 GPS RSS VELOCITY RESIOUAL VS. TINE 


DEFINITION OF 
X< 1.1) 

X ( 1.2) 

X ( 1.3) 

X ( 1.4) 

X< 1.5) 

X( 1.6) 

X( 1.7) 

X< 1,8-1 1 ) 
X( 1,12) 

X< 1.13) 

X i 1.14) 

X< I . 15) 

X< I . 16) 

X( 1.17) 

X< 1.18) 

X( 1.19) 

X< 1.20) 

X ( 1.21 ) 

X( 1.22) 

X( 1 .23) 


TIME 

X PCS ERROR 

Y POS ERROR 
Z POS ERROR 
X VEL ERROR 

Y VEL ERROR 
Z VEL ERROR 
QUATERNION ERRORS 

LN HORIZONTAL RESIDUAL 
LN VERTICAL RESIOUAL 
STAR TRACKER 1 RESIDUA1 


GPS X POS RESIDUAL 

• y • " 

■ z ■ 

GPS X VEL RESIDUAL 

■ y • * 

• z • 


HORIZONTAL 

VERTICAL 

HORIZONTAL 

VERTICAL 


— - START OF PLOTS 


0011 

C 

OP EN ( UN I T *2 . NAME* 'PLOT .DAT 1 

0012 


1*1 

0013 

10 

CONTINUE iv , 

0014 


RE A0( 2 ,900 , END *20) (X ( I .U ) .U 

0015 


1*1 + 1 

0016 


GO TO 10 

0017 

20 

CONTINUE 

0018 


IN UN* 1 — 1 

0019 


NR ITE(5 , 2) INUN 


PLOTSMAIN 


VAX-11 FORTRAN V2.0-2 
_OBB4 j t b . ccr] plot . for ; 28 


p«g* 3 


3 

3 


-Nov-1980 08:30:54 
-Nov-1980 08:30:21 


> 

i 

t' 

o 


0020 

2 

FORMAT! ' TOTAL OATA VALUES READ IN MAS 

0021 


MR I TE! 5 . 908 ) 

0022 


RE AD! 5.909)ATYPE 

0023 

30 

CONTINUE 

0024 

40 

CONTINUE 

0025 


MR ITE! 5.901 MMENU1 ( I ) . I«1 .23) 

0026 


MR I TE ( 5 , 902 ) 

0027 


RE AD! 5. 903, ERR «40)I TYPE 

0028 


IF ( ITYPE .EQ.-1 )GO TO 890 

0029 


MR ITE!5. 904) 

0030 


RE AO! 5 . 903 , ERR .40) IR FNUM 

0031 


MR I TE ( 5 . 905 ) X( 1,1).X( INUM. 1 ) 

0032 


RE ADIS . 906 , ERR *40 ) RS TART . R STOP 

0033 


IF (RSTART .LT.RSTOPJGO TO 45 

0034 


MRITEI 5,907) 

0035 


GO TO 40 

0036 

45 

CONTINUE 

0037 


IF( RSTpP . GT . X ( INUM, 1 ) )RSTOP«X( INUH.1 ) 

0038 


IF ( RSTART. LT.X( 1.1 )) RSTART -X<1.1 ) 

0039 


IFIATYPE.EO. 'H'JGO TO 47 

0040 


CALL tk 

0041 


GO TO 48 

0042 

47 

CONTINUE 

0043 


CALL HP7221 

0044 


CALL QQNP(0 . 0,0.0,61 

0045 

48 

CONTINUE 

0046 


CALL OPNPLT 

0047 


CALL XLABEL! ' TIME (SEC.) ’.14) 

0048 


CALL YLABEL(VTIT((ITVPE-1 )*40*1 ) ,40) 


’.IB) 


0049 

0050 

0051 

0052 

0053 

0054 

0055 
0050 

0057 

0058 

0059 

0060 
00F1 
0C 62 
oot,:* 

0064 

0065 

0068 


0067 

0068 
0069 



111 

50 

60 


70 

80 


90 


100 

c 

c 


FIND THE BOUNDS ON THE TIME 

DO 50 I.1.1NUM-1 . x 

IF(RSTART.GE.X(I.1 ) .ANO . RSTART . LE. X( 1*1 , 1 ) )G0 TO 60 
MR I TE ( 5 . 1 1 1 ) RSTART ,*|I.1).MI*1.1) 

FORMAT ( ' RST ART ,K( I).X(I*1) '.3F15.7) 

CONTINUE 

CONTINUE 

ITSTRT.I 

00 70 I«1,1NUM-1 

IF1RSTOP.GE. X( 1 .1 ) .ANO.HSTOR.LE.XI 1*1 ,1) )QO TO 80 
CONTINUE 
CONTINUE 
I T STOP* 1*1 

ITNUM«ITST0P-ITSTRT*1 
00 90 I>1 , ITNUM 

TIME! I )»X! I* ITSTRT -1 .1 ) 

GO TO ( t 00 , IOC , 100 .200 , 1 00 , 100 , 1 00,200 . 300,300,300 . 400 ,500 ,500 , 
• 500 ,500 ,500,500,500 ,500.500,600 , 500 ,800 , 500 , 600 ) I TYPE 

CONTINUE 

NAVIGATIONAL ERROR TYPE OF PLOT 
I T YPE1 * I T VPE 

IF(ITYPE1 . LE • 3 ) I TYPE 1*ITYPE1+1 
DO 110 I-1.ITNUM 


PLOTSMAtN 


0070 


YARAV ( I )*X(1*ITSTRT 

007 1 

110 

CONT INUE 

0072 


GO TO 800 

0073 

200 

CONTINUE 


c 

c 

RSS ERROR TYPE OF PLOT 


3-NOV-1980 08 = 30:5*. 
3-Hov-1980 08:30:31 


WAX-11 FORTRAN V2.0-2 
_DBB4: [ B. GCP]PL0T . FOR ; 28 


P»g* 


0074 


I T VPE1 *4 

0075 


I F ( 1 TYPE . £0 • 8 ) I TYPE 1 *7 

0076 


00 210 1*1 .1TNUN 

0077 


V AR A V ( IMS<JRT<X< I ♦ 1 T5 
• X( !♦ I TS 

. X < !♦ IT* 

0078 

210 

CONTINUE 

0079 


GO TO 800 

0080 

300 

c 

CONTINUE 


c 

c 

ATTITUDE ERROR 

0081 


DO 310 1*1,1 TNUN 

0082 


VARA Y ( I ) * l X( I+ITSTRT 

0083 

310 

CONTINUE 

0084 


GO TO BOO 

0085 

400 

CONT INUE 


C 

c 

RSS ATTITUDE ERROR 

0086 


DO 410 1*1,1 TNUN 

0087 


YAP AY ( I ) * < 2* SORT ( X ( I 
• X ( I ♦ I TSTR T — 

ooee 

410 

CONTINUE 

0089 


GO TO 800 


c 

c — 
c 

RESIDUAL TYPE OF PLOT 

0090 

500 

CONT INUE 

0091 


I T YPE 1 * I TYPE-1 

0092 


IF < I TYPE .GE.23 ) IT YPE 1* 

0093 


OO 510 1*1, ITNUN 

0094 


YARAY< I )*X( I ♦ITSTRT- 

0095 

510 

CONTINUE 

0098 


GO TO 800 


c 

c — 
c 

RSS TYPE FOR RESIDUALS 

0097 

600 

CONTINUE 

0098 


I T YPE1 * 1 8 

0099 


if<itype.eo.2S)itypei 

0100 


00 610 1*1 .ITNU* 

0101 


YARAY< 1 ) *2 . * SORT ( X ( 
• *< 

• *( 

0102 

610 

CONTINUE 

0103 


GO TO 800 

0104 

800 

.ON"- *NUE 

OIOS 

CAL .INPLT(TIME.YARA 

0106 


IF <«TYPE ,EQ. 'M ' )CALL 


, ITVPE)*2.)/.4848E“S 


♦lib '«• 1 _ 

1 , 10 )**2*X( ITSTRT*l-1 . 1 1 ) • • 2 ) ) / • 48 4BE- - 


, I TYPE 1 )»**2* 

, ITYPEH-1 )»*2 + 
, ITVPE1«'2)**a) 


,Y.ITNUW) 
OQHP (1.0,0, 


0 . 6 ) 


A- 34 2 


Pag* % 


ET 


PLOTSMAI* 


J-Nov-1 980 00:30:94 
J-Nov-1 910 08:30:31 


VAX-11 FORTRAN V 2.0-2 
_OBM : [ 8 . GCP 1 P LOT . FOB : 28 


0 1 07 


0108 


0109 


01 10 


01 1 1 


0112 

890 

0113 

900 

0114 

901 

0119 

902 

01 IB 

903 

OUT 

904 

01 IB 

905 

0118 

906 

0120 

907 

0121 

908 

0122 

909 

0123 



CALL GRIOI2.2) 

IF<ATYPE.EQ.'H')CALL OOMPlO. ,°. .«> 

CALL HEA 0 IN(ATtr((ITtPE-U- 0 > 1 ).- 40 .- 2 .t) 
CALL ENOPL(O) 

GO TO 40 
CONTINUE 
FORMAT) 33F20. 1 0) 

FORMAT ( A60 1 MiinRFfl : 

FORMAT)' INPUT DISPLAY TYPE NUMBER 

FORMAT) ' 2 INPUT REFERENCE FRAME DUMBER S 
fSSIM- INPUT START. STOP TIME FOR PLOT 
• MIN MAX TIMES ARE • . 2F10 . 3. SX.S ) 

FO«t T Tr F Mi‘iTART.ST0P TIMES MERE INPUT 
FORMAT! ' SSurSiTWT DEVICE ( T OR H) « 
FORMAT! At ) 

END 


*.*) 

’.*) 


’) 

.«) 


PROGRAM SECTIONS 
Name 

0 SCOOE 

1 SPOATA 
a SLOCAL 


Bytaa Attributes 


1516 

360 

303772 


PIC CON REL LCL 
PIC CON REL CCt 
PIC CON BEL tCL 


SMR EXE 
SHR NOEXC 
MOSMR NOEXE 


30 NOMP ' LONG 

ro nomrt long 

RD MRT LONG 


ENTRY POINTS 

Addraaa Typ* Hama 
0-00000000 PLOTSMAIN 


variables 


Addrass 

2-00031B26 
2-00031B50 
2-00031BS4 
2-00031 B2C 


Typ* Na»a 

L*1 ATYPE 
1.4 I TNUM 

1*4 ITYPE1 
».4 RSTOP 


Addrass T ypa N*mr 


2-00031 B30 
2-00031 B4C 
2-00031634 


1*4 I 
1*4 ITST05* 
1*4 J 


Address 

Type 


2-00031 B3C 

1-4 

INUM 

2-00031048 

I»4 

ITSTRT 

2-00031038 

X»4 

K 


Address Typ* 

2-00031 B44 1 *4 

2-00031 B40 1*4 

2-00031 B2S R*4 


i ARRAYS 

I Addrass Type 


Bytes D I mans 1 one 


2-00000410 

2-00031594 

2-0003D6E0 

2-00000410 

2-00000820 


L* 1 ATIT 
CHAR MENU1 
8*4 TIME 
CHAR TITLES 
R*4 X 


1040 11040) 

1426 123) 

BO 00 ! 2000) 

1040 !26) 

184000 12000. 23) 


Name 

IRFNUM 

ITYPE 

RSTART 


Pao* 


RLOTSMAIN 


3-MOV <80 08:30:54 VAX-11 FORTRAN V2.0-2 

3-Nov- 1 980 08:30:21 _DBB4: tB.&C*lPL0T.F0R:28 


2-00031560 

2-0002F620 

2-00000000 

2-00000000 

R*4 

R*4 

L»1 

CHAR 

XF1LL 

VARAT 

VTIT 

TTITLE 


52 

8000 
1 040 
1040 

(13) 
(2000) 
( 1 040) 
(26) 








LABELS 














Address 

Lap# 1 

Address 

Labe 1 

Address 

Lada) 

Address 

Labe I 

Address 

label 

Address 

Labe) 

1-00 000000 
0-00 00023C 
« • 

0-00 00043 A 

0- 0000051C 

1- 00000049 
1-00000101 

2 ' 

47 
90 
300 
600 
902 ' 
908' 


0-00000015 

0-00000248 

0- 00000385 

• • 

• • 

1- 00000060 
1-00000125 

10 

18 

100 

310 

610 

903' 

909 

* 

0-00000072 
• • 

• • 

0-00000476 

0- 00000590 

1- 00000070 

20 
SO 
110 
400 
BOO 
904 ' 

• • 

0- 00 0002DF 

1- 00000024 

• • 

0- 000005EB 

1- 00000094 

30 
60 
111 ’ 
41 0 
890 
905* 

O-OOOOOOCE 
• • 

0-00000 3C6 

0- 00000406 

1- 00000040 
1 -00000007 

40 

70 

200 

500 

900' 

906' 

0-00000200 

0- 00000313 

• • 

• • 

1- 00000046 
1 -OOOOCODO 

45 

80 

210 
510 
901 ' 
907' 


FUNCTIONS AND SUBROUTINES REFERENCED 

ENDPL FORSOREN GRID 

QQMR T* X LABEL 


MEAOIN 

YLABEL 


MP7221 


LINPLT 


KTHSSORT ORNPLT 


Total Spaca Ailocatad ■ 205*48 Bytas 


command oualIFIERS 


> 

i 


FORTRAN /CO : 40 PLOT/LIS 


/CHECH*! NO BOUNOS .OVERFLOW) 

S5r;i5S5S«^r;ipT».i« /markings /noo.umes /NOMACHINE.COOE /CONTINUATIONS.40 


COMPILATION STATISTICS 

Run T ' me : 4.67 seconds 

Elaosed Tiaia: 19. 1 7 seconds 

Pag* Fau'ts: 234 

Dynamic Xotoryi *2 pages 


6-Apr- 1 98 1 15=02:41 

2 1 -Jan- 1 901 12 = 32=15 


VAX-11 FORTRAN V2.0-2 
_OBA?= (01 1 R. GC P 1 PMEAS . FOP : 9 


Page 


1 


i 

•t- 

•C- 


00100 

0001 


00200 


c 

00300 


C* ** 1 

00400 


c 

0C500 


c 

00600 


c 

00700 


c 

00800 


c 

00900 


c 

01000 


c 

01100 


c 

01200 


c 

01300 


c 

01400 


c 

01500 


c 

01600 


c 

01700 


c 

01800 


c 

01900 


c* *• 

02000 


c 

02100 

0002 


02200 

0003 


02300 

0004 


02400 


c 

02500 


c* • » 

02600 


c 

02700 


c* •* 

02800 


c 

02900 

0005 


03000 

0008 


03100 

0007 


03200 


c 

03300 


c» * • 

03400 


c 

03500 


c* *< 

03600 


c 

03700 

0008 

100 

03800 

0009 


03900 

0010 


04000 

0011 


04100 

0012 


04200 

0013 


04300 

0014 



SUBROUTINE PM AS(PU,U,PQH, PDV , 1 FLAG ) 


subroutine pm as computes the partials of the measurement 

WITH RESPECT TO ThE ESTIMATED STATE USING THE PARTIAL OF 
THE UNIT VECTOR (PU) WRT THE ESTIMATED STATE AND THE 
UNIT VECTOR ITSELF. 

INPUT PAQAMF t RS 

PU =. THE PARTIALS OF THE UNIT VECTOR WRT THE 

ESTIMATED STATE 

u = THE MEASUREMENT UNIT VECTOR ITSELF 

OUTPUT PARAMETERS 

PDH = THE PARTIALS OF THE HORIZONTAL DIFLECTION 

POV * THE PARTIALS OF THE VERTICAL DIFLECTION 

CALLED BY hstar AND HLMT 


DIMENSION PU ( 3 ) • U ( 3) 

REAL*8 POH.POV.PU.U.A.B.C 
I F ( I FLAG .GT . 1 ) GO TO 1 00 


COMPUTE PART 1 ALS OF MEASUREMENT VECTOR (APPROXIMATE) 


PDH*PU (2) 
POV=PU< 1 ) 
RETURN 


COMPUTE EXACT PARTIALS OF MEASUREMENT 


A-1 . /SORT ( 1 . -U< 1 ) *U( 1 ! ) 

PDV«A»PU( 1 ) 

B = COS( ASIN( U ( 1 )) ) 

C»1 . /SORT ( 1 . -(U(2I/B)**2) 
PDH«C*(B*PU(2)+U(2)*U(1 )*A»PU(1 ))/(»•■) 
RETURN 
END 



VARIABLES 



Name 


bytes 


At tr \ putes 


0 SC ODE 
2 SLOCAL 


163 

64 


PIC CON PEL. LCL SHR EXE 
PIC CON REL LCL NOSHR NOEXE 


RD NOWRT LONG 
RD WHT QUAD 


ENTRY POINTS 

Address Type Name 
O'O'. OOOOOO 


PMEAS 


Address 

Type 

Name 

Address 

T ype 

Name 

Address 

Type 

Name 

Address Type 

Name 

2-00000000 
AP— 00 OOOOOC# 

R*8 

H»8 

A 

PDH 

2-0000000R 
AP-00000 0 1 0# 

R*6 
fl * B 

B 

POV 

2-00000010 

R»8 

C 

AP 00000014* l«4 

I FLAG 


ARRAYS 

Address Type Name 


Bytes Dimension* 


AP-00000004* R*8 
A P-00 000008V R*B 


PU 

U 


24 C 3 > 
24 (3) 


LABELS 

Address Lade l 
0-00000034 100 


FUNCTIONS AND SUBROUTINES REFERENCED 
MTHSDASIN MTHSDCOS MTHSDSORT 


Total Space Allocated * 227 Bytes 


COMMAND QUALIFIERS 

fortran /list gcp, inoata. mat ab.outdata. rung. dnav.ephem.truea.spress. occult, gpert.gcpseo. visible. genenv.treg.gyrout. rate. bmat.cma 


/CHECKS ( NO BOUNDS .OVERFLOW) 

/DEBUG* ( N0SYM80L S . TRAC EBACK ) 

/F77 /NOG.FLOATING /I4 /OPTIMIZE /WARNINGS /N0D_LINES /NOMACHINE .CODE /C0NTINUATI0NS*19 










litiiiMaittiMMtii 






PMEAS 


COMPILATION STATISTICS 

0.86 second* 
18.87 seconds 
333 

160 pages 


Run Time: 
Elapsed Tim*: 
Page Faults: 
Dynamic Memory: 




6-Apr-1981 15:02:41 VAX-11 FORTRAN V2.0-2 
21 -Jan-1 981 12:32:15 _D8A0: (01 1 R.CCP JPMEAS. FOR: 9 




6 ~ Apr - 1 081 14:51:17 

1 1-bep-1 980 11 : 5 1 : 05 


Page 1 


VAX-11 FORTRAN V2.0-2 
_DBA0: {01 1R.GCT ;0VJl T . FOR; 4 


0001 


SUBROUTINE QMULT (A.B.CI 





C* 

c 

THIS SUBROUTINE DOES A QUA T RM ON 

MULTIPLY AND 

RETURNS ANSWER IN C 

0002 

c« 

DIMENSION A!4).B(4).C(4),DI3) 




0003 


REAL *8 

A.B.C.O 




0004 

c 

D( 1 ) 

a 

A ( 1 ) * B ( 1 ) - A ( 2 ) • B ( 2 ) 

- A ( 3 ) * 8 ( 3 ) 

- 

A ( 4 ) * B ( 4 ) 

0005 


D ( 2 ) 

s 

A ( 1 ) * B( 2 ) ♦ A( 2 ) »Bt 1 1 

+ A ( 3 ) * B ( 4 > 


A ( 4 ) * B( 3 ) 

0006 


D ( 3 ) 

3 

A ( 1 ) • 0 < 3 ) - A( 2 )«B(4) 

+ A ( 3 ) * B ( 1 ) 

♦ 

A ( 4 ) * B ( 2 ) 

0007 


C ( 4 ) 

3 

A ( 1 ) *B( 4 ) A( 2 ) * B( 3 ) 

- A ( 3 ) * B( 2 ) 

♦ 

A ( 4 ) *B( 1 ) 

0000 


C( 1 ) 

a 

D( 1 ) 




0009 


C<2) 

* 

0(2) 




0010 


C(3) 

* 

0(3) 




001 1 


RETURN 





0012 


END 







PROGRAM sections 



Name 

Bytes 

Attributes 







0 

SCOOE 

210 

PIC CON REL 

LCL 

SHR 

EXE 

RO 

NOWRT 

LONG 

2 

SLOCAL 

84 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 


ENTRY POINTS 

Address Type Name 
0-00000000 QMULT 


ARRAYS 


Address T 

ype 

Name 

Bytes 

0 1 mens i on* 

AP-00000004e 

R*8 

A 

32 

(4) 

AP-00000008P 

R*8 

B 

32 

(4) 

AP-OOOOOOOC# 

R*8 

C 

32 

(4) 

2-00000000 

R»8 

D 

24 

(3) 


Total Space Allocated * 294 Bytes 


command qualifiers 

FORTRAN /LIST GCP, INOAT a .MATAB.OUTOATA. RUNG, dnav.ephem.truea.spress.occult .gpert , gcpseq .VISIBLE .GENENV .TREG. GY ROUT, RATE. BMAT , CMA 
/CHE CK = ( NO BOUNDS .OVERFLOW) 

/DEBUG 3 ( NOSYMBOL S , TRAC EBACK ) ... 

/F77 /NOG_FLOAT ING /I4 /OPTIMIZE /WARNINGS /NOO_LINES /NOMACHINE_COOE /CONT INUAT I0NS*1 9 


-348 


P.i. 


OMULT 


COMPILATION STATISTICS 

Run Time: 1.07 seconds 

Elapsed Time: 14.16 seconds 

Rage Faults: 293 

Dynamic Memory: 160 pages 






WaPP*^ 




6 - Apr-1 981 14:51:17 VAX-11 FORTRAN V2.0-2 
1 1 -Sep“1 960 11 -.51:05 _DBA0:[D1 1R.GCF 1<3MULT.F0R:4 


Rage 2 


SUBROUTINE ROOTA'' T .THE1 , AL) 


10-ad 1 — 1 981 08:40:57 
10-Ap.'-1981 08 = 52=11 


VAX-11 FORTRAN V2.0-2 
_DBAO: [ D 1 1 R . GC - , ROOT A . FOR ; 1 7 


Page 


00100 

0001 


OC 200 


C 

00300 


C* *•' 

00400 


c 

CC500 


c 

00 600 


c 

0-700 


c 

OCBOO 


c 

00 900 


c 

01000 


c 

01100 


c 

01200 


c 

01300 


c 

01 400 


c 

0(500 


c 

01600 


c 

01700 


c 

01800 


c 

0 1 900 


c 

02000 


c 

02100 


c 

02200 


c» *• 

02300 


c 

02400 

0002 


00100 

0003 

• 

> 00200 


• c 

_ 00300 


• c 

oo4oo 


• c 

" 00500 


* c 

00600 


• c 

OL 700 


• c 

OCBOO 


• c 

00900 


• c 

0 1 000 


• c 

01100 


• c 

0 1 2C0 


• c 

01 TOO 


• c 

L 1400 


• c 

01500 


• c 

02500 

0004 


02600 

0005 


02700 

0006 


02800 

0007 


02900 

0008 


03000 

0009 

10 

03100 

0010 


03200 

001 1 


03300 

0012 


03400 

0013 


03500 

0014 

20 

03600 

0015 


037C0 

0016 

100 

03B00 

0017 



SUBROUTINE ROOTA h 
A DATA T A8LE AT TH 


EADS THE VALUE OF THET AND AL FROM 
E TIME CLOSEST TO TIME T. 


INPUT DATA 

T i TIME OF MEASUREMENT 


OUTPUT DATA 
THET 
AL 


LOOK ANGLE TO LANDMARK (RAD) 

ALTITUDE OF LANDMARK ABOVE EARTH MEAN 
SURFACE (KM) 


CALLED BY RDGCP 

THET IS INITIALLY A FLAG 
THET .GT. 90. DEG 
THET .LT. 90. DEG 


PICK RANDOM THET AND AL 
KEEP THET, SET AL*0. 


1NCLU0E 'MODE . COM ’ 

COMMON /MODE/ MODE (10) 

M0DE(1) * LANDMARK TRACKER SWEEP MODE 

0 * RANDOM 

1 = FIXED AT INPUT THET 

2 = NO DEFAULT TO STAR TRACKER 
MOOE ( 2 ) ■ CLOUD SELECTION MODE 

0 * random cloud densities baseo 

ON INPUT TABLES CLOTBL 

1 = fixed density at no clouds 

2 = no CLOUDS with 1 00% CLOUD 

COVER FOR A SPECIFIED 
PERIOD (CL0TBU1 1 ,12) ) 
MODE (3-10) NOT SPECIFIED AT PRESENT 

DATA II, 12, IFLAG/12345. 54321,0/ 

REAL *8 AL.T. THET . R AN , GAU SS , X , THETP 
IF( I FL AG .GT . 0) GO TO 10 
IFLAG= 1 

THET P= THET *3 .1415926536/180. 

GO TO ( 20,20 ) .MODE ( 1 ) 

THET = ( RAN( II , 12 ) - . 5 ) *2 . * THETP 
X =GAUS 5 ( 0 . , . 5) 

AL=ABS ( X ) 

GO TO 100 
THET * T HETP 
AL*0. 

RETURN 

END 


A-350 


(**»> 


ROOT A 

PROGRAM sections 
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Name 

Bytes 

Attr 1 butes 




0 

SCOPE 

1 10 

PIC CON REL 

LCL 

SHR 

EXE 

1 

SPOATA 

8 

PIC CON REL 

LCL 

SHR 

NOEXE 

2 

Slocal 

52 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

3 

MODE 

40 

PIC OVR REL 

GBL 

SHR 

NOEXE 


RD NOWRT LONG 
RD NOWRT LONG 
RD WRT QUAD 
RD WRT LONG 


ENTRY POINTS 


Address Type Name 
0-00000000 ROOT A 


VARIABLES 


Address Type 

Name 

Address 

Type 

s 

2 

AP-00 OOOOOCS R«8 

AL 

2-00000010 

I *4 

n 

AP— 00 000004 S R*8 

T 

AP-00000008S 

R*8 

THET 


Address 

Type 

Name 

Address 

Type 

Name 

2-00000014 

2-00000008 

1*4 

R*B 

12 

thetp 

2-0000001B 

2-00000000 

1*4 

R*8 

I FLAG 
X 


ARRAYS 


Address 

3-00000000 

Type Name 
1*4 MODE 


Bytes 

40 

Dimensions 

(10) 


LABELS 

Address 

Label 

Address 

Label 

Address 

Label 

0-00 0000 2C 

10 

0-00000065 

20 

0-00000060 

too 


FUNCTIONS and subroutines referenced 
forsiran gauss 


Total Space Allocated • 210 Bytes 


command qualifiers 

FORTRAN /L ROOT A 

/CHECK* ( NOBOUNDS .OVERFLOW) 

/DEBUG* ( NO SYMBOL S , TRACEBACK ) 

/F77 /NOG.FLOAT ING /I4 /OPTIMIZE /WARNINGS /NOD.LINES /NOMACHINE.COOE /C0NTINUATI0NS-19 




Psoe 2 


ISC-' 



I 


10-Apr-1981 08:40:57 VAX-11 FORTRAN V2.0-2 
1 0-Apr-1 981 08:32:11 _DBAO: ID 1 1 R.GCP JRDDTA . FOR : 1 7 


COMPILATION STATISTICS 

0.83 seconds 
7.44 seconds 
149 

39 pagss 


f 


Run Time: 
Elapsed Time: 
Page Faui t»: 

| Dynamic Memory: 


> 








Page 3 



00100 
00200 
00300 
0C400 
00500 
00600 
00700 
ooeoo 
00900 
01000 
01100 
01200 
01300 
01400 
01500 

01 coo 

01700 

01800 

01900 

02000 

02100 

00100 

00200 

00300 

00400 

00500 

00600 

00700 

00800 

00900 

01000 

01100 

01200 

01300 

01400 

01500 

01600 

01700 

01800 

01900 

02000 

02100 

02200 

02300 

02400 

02500 

02200 

02300 

02300 

02300 

02300 

02300 

02300 

02300 

02300 

02300 

02300 


0001 


<;*••••< 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c* •••< 
c 




0002 

0003 

0004 

ooos 


• 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 


0006 

0007 

0008 


• c 

• c 

• c 

• c 

• c 

• c 

• c 

• c 


SUBROUTINE RDGCP 

;r 

OUTPUT PARA-ETERS landmark LONGITUDE (DEG) 

« ■ LATITUDE (DEG) 

« • altitude above mean (km) 

CALLED BY MEASURE 


THET 


landmark tracker p^^er 5 


AL 
LON 
LAT 
T8NL 

TNL 

BL 

SL 

BKL 

THET 

SKL 

TIEO 

TNLK 

SIGGCP 


ALTITUDE OF LAN.MARK (KM) 

LONGITUDE OF LANDMARK (DEG) 

LATITUDE OF LANDMARK (DEG) 

. ORIENTATION ARRAY FOR LANOMARK TRACKER 
NOMINAL TO BOOY 
, MISALIGNMENT ARRAY - actual 
TRACKER TO NOMINAL 

! NOISE STANDARD 1 DEVIATION - ACTUAL (RAD) 

■ BIAS - KNOWLEDGE (RAD) 

: NO?SE*STANOARO D DEV I AT ION “KNOWLEDGE (RAD) 

• initial earth fixed to inertial 

TRANSFORMATION 

. MISALIGNMENT ARRAY KNOWLEDGE 
TRACKER TO NOMINAL 

, POSITION UNCERTAINTY DUE TO CLOUDS 


CO»«ON U /ENVIR/ 1 STATE ( 10). PROF I LE( 10.4). INIT 

REAL'S STATE. profile 

REAL WORLD STATE PARAMETERS 


STATE 

PROFILE 

INIT 


STATE VALUES! * 2 • !? ’ ? 0 *?° ‘ M “ 
ATTITUDE PROFILE-TIME (SEC) 

INERTIAL APiGUUAM "ATES C«A0/SE C > 

integration INITIALIZATION KEY ( 1) 


RDGCP 
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02300 

0009 



INCLUDE 1 ARRAYS . COM ' 


02400 


• 

c 



02400 

0010 

• 


COMMON / ARRAYS / T 1 ( 3 ) . T2 ( 3 ) . T3 ( 3 ) , T4< 1 0 ) , T 1 1 ( 3 . 3 ) . T 33< 3 . 3 ) 

02400 


* 


,T44t 4.4) .166(6.6 ),T77< 6,6) ,T5( 4) ,T6(4) ,T7(4) 

02400 

00: 1 

• 


REAL'S T1.T2.T3.t4.T1l. 

T 33 . T 44 , T 66 , T77 , T5, T6 . T7 

02400 


« 

c 



02400 


* 

c 

THESE ARE TEMPORARY STORAGE ARRAYS FOR USE BY ALL MODULES 

02400 


* 

c 



02400 


* 

c 

T 1 - T 4 

SINGLE DIMENSION ARRAYS 

02400 


• 

c 

Til - T77 

DUAL DIMENSIONED ARRAYS 

02400 


• 

c 

Til 

DUAL ARRAY; OFF DIAGIONAL SET TO ZERO 

02400 


• 

c 



02400 

0012 



INCLUDE 'TARG TS.COM' 


02500 

0013 

« 


COMMON /TARGETS/ MTyPE, 

IS.NS.JFlAG.MCODE.PI ,tpi 

02500 

0014 

• 


LOGICAL jflag 


02500 

0015 

• 


REAL'S PI.TPI 


02500 


♦ 

c 



02500 


• 

c 

MEASUR MENT SPECIFICATIONS 

02500 


• 

c 



02500 


• 

c 

MTYPE 

measurement type 

02500 


• 

c 

JFLAG 

SET FOR STAR OBSTRUCTION 

02500 


• 

c 

MCOOE 

" * MEASUREMENT PROCESSING 

02500 


• 

c 

l»I 

PI 

02500 


• 

c 

TPI 

2* P I 

02500 


• 

c 



02500 

0016 



INCLUDE 'TIME.COM' 


00100 


• 

c 



00200 

0017 

• 


COMMON /TIME/ TIME. T NEXT .TST0P.T1A.0EL.TIN, DTN .DAT EO , TZE RO 

00300 


• 


. .TME AS. TRACK .tis.tisn.ota.dater.tprint .dtprint 

00400 

0018 

• 


REAL'S TIME.TNEXT.TSTOP 

. TI A.OEL . TIN, DTN.DATEO.TMEAS, TRACK. TIS. 

00500 


• 


. TI SN , DT A, T2ER0.DATER.T PRINT, DTPRINT 

0C600 


• 

c 



00700 


* 

c 

THESE ARE THE 

time reference FRAMES 

00800 


• 

c 



0 0900 


• 

c 

TIME 

ATOMIC TINT SINCE INITIALIZATION (SEC) 

01000 


• 

c 

TNEXT 

time for NEXT POSITION INTEGRATION (SEC) 

01 100 


• 

c 

tstop 

RUN TERMINATION TIME (SEC) 

01200 


• 

c 

tia 

ATTITUDE INTEGRATION TIME (SEC) 

01300 


• 

c 

D L 

’ * STEP SIZE (SEC) 

01400 


• 

c 

TIN 

POSITION INTEGRATION TIME (SEC) 

01500 


• 

c 

DTN 

" " STEP SIZE (SEC) 

01600 


• 

c 

DATEO 

DATE OF FLIGHT EPOCH (JD) 

01700 


• 

c 

DATER 

DATE OF 1950 EPOCH (JD) 

01800 


• 

c 

TZERO 

START TIME IN SECS. SINCE DATEO 

01900 


* 

c 

TSLEW 

TIME NEEDED to SLEW AND ACQUIRE (SEC) 

02000 


• 

c 

TIS 

REAL WORLD REFERENCE TIME (SEC) 

02100 


• 

c 

TISN 

TIME FOR NEXT RW POSITION INTEGRATION (SEC) 

02300 


• 

c 

DT A 

USUALLY ♦ DEL BUT ♦ T SLEW - TIA WHEN DEL 

02300 


• 

c 


TOO LARGE AT MEASUREMENT TIME 

02400 


• 

c 

TPRINT 

time for PRINT (SEC) 

02500 


• 

c 

OTPRIM 

INCREMENT ON TPRINT (SEC) 

02600 


• 

c 



02600 

0019 



INCLUDE 'NSTATE.COM' 


02700 


• 

c 



02700 

0020 

• 


COMMON /NSTATF. / XD< 6 ) . *( 6 ) ,RADM. RADE 

02700 

0021 

• 


REAL'S XD.X.RAON.RALE 


32700 


• 

c 
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> 

u- 


02700 

02700 

02700 

02700 

02700 

02700 

02700 

02700 

02700 

02800 

02900 

03000 

03100 

03200 

03300 

03400 

03500 

03600 

03700 

03800 

03900 

04000 

04100 

04200 

04300 

04400 

04500 

04600 


0022 


0023 


0024 

0025 

0026 


• C 

• c 

• c 

• c 

• c 

• c 

• c 

• c 


c 

o 

c 

c» 

c 


c 

c«< 

c 

c 

c 

c 

o« 

c 


04700 

0027 


04800 


C 

04900 


c«« 

05000 


c 

05100 


c»« 

05200 


c 

05300 

0028 


05400 

0029 


05500 

0030 

10 

05600 

0031 


05700 

0032 


05800 

0033 


05900 

0034 


06000 

0035 


06100 

3036 


06200 


c 

06300 


c* 

06400 


c 

06500 


c* 

06600 


c 

06700 

0037 


06800 

0038 


06900 

0039 


07000 

0040 


07100 

0041 


07200 


c 

07300 


c« 

07400 


c 

07500 


c 


POSITION STATE AND CONSIDERED PARAMETERS 

X0 STATE DERIVATIVES (KM/SEC AND KM/SEC/SEC) 

X STATE POSITION PARAMETERS (KM AND KM/SEC) 

RAOM RADIUS OF THE MOON (KM) 

RADE EARTH OETECTABLE RADIUS (KM) 


DIMENSION UL<3) .TLL13.3) ,ULL( 3 ) ,TBI ( 3 ,3) . T 18(3. 3 ) ,ULI ( 3 ) . 
M( 3 ) , LI ( 3 ) ,T1E(3,3).TEI(3,3), LE( 3) , T I L( 3 , 3 ) ■ 

DOWN i 3) . UCD1 3) 

EQUIVALENCE (RE.3ADE) 


GENERATE UNIT VECTOR ALONG LMT BORES IGHT 


UL( 1 ) *0. 
UL( 2 ) « 0 . 
UL( 3) ■ 1 • 


READ A LOOK ANGLE TO AND AN ALTITUOE OF THE LA NO MARK 

FROM THE DATA FILE 

LOOK ANGLE IS RELATIVE TO 800V AXES ABOUT THE 
X-BODT AXIS 


CALL RDOTA(TIME.THET.AL) 


TRANSFORM UNIT VECTOR BT LOOK ANGLE 


DO 10 !>1 .3 
DO 10 «J«1.3 
TLL( ; . J)«0. 

TLL( 1 , 1 )«1 • 

TLL( 2 , 2 )»COS ( TME T ) 
TLl(3.3)«TLL(2.2) 

TLL(2. 3)«-SIN? THET ) 

TLL(3. 2|*-TLL(2.3» 

CALL MATAB(TLL.UL.ULL.3.3,1) 


TRANSFORM UNIT VECTOR TO INERTIAL COORDINATES 


CALL AMAT(STATE(7) ,T8I ) 

CALL MINV3(TBI .TIB) 

CALL MATABITBNL. TNL . T33 . 3, 3 ,3) 
CALL MATAB(TIB.T33.T1L,3,3.3) 
CALL MATAB( TIL.ULL.ULI.3,3,1) 


DETERMINE ANGLE OF UNIT VECTOR ALONG LANOMARK 
DIRECTION RELATIVE TO LOCAL OOWN 


Paga 4 
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> 

1 

01 

a* 


07600 


c*. 

07700 


c 

07800 

0042 


07900 

0043 

15 

08000 

0044 


08100 

0045 


08200 

0048 


08300 


c 

08400 


c* • 

08500 


c 

08600 


c« • 

08700 


c 

08800 

08900 

09000 

0047 


09100 


c 

09200 


c* « 

09300 


c 

09400 


c*« 

09500 


c 

0*1600 

0048 


09700 

0049 

20 

09800 


c 

09900 


c*< 

10000 


c 

10100 


c* < 

10200 


c 

10300 

0050 


10400 

0051 

30 

10500 


c 

10600 


c« 

10700 


c 

10800 


c* 

10900 


c 

11000 

0052 


11100 

0053 


11200 

0054 


11300 


c 

1 1400 


c* 

11500 


c 

1 1600 


c* 

1 17C0 


c 

11800 

0055 


1 1900 

0056 


12000 

0057 


12100 

0058 


12200 

0059 



DO 15 1*1.3 

DOWN! t ) *-ST A T (It 

CALL VCRSIUL I .DOWN .UCDI 

STHETP* VMAGI UCD . 3 ) / VMAG( DOWN. 3) 

THETP.ASIN(STHE.P) 


FINO LENGTH OF VECTOR FROM S/C TO LM 


8* SORT ( VMAGI STATE ,3)**2*(RE*AL) **2“2 . »VMAG( STATE ,3)» 
( RE* AL ) *COS( -THETP+ASI N( VMAGI STATE .3)* 

S I N ( TMET P ) / ( RE+AL ) ’ ) ) 


ESTABLISH VECTOR 


DO 20 1*1.3 
W( I)*B*ULl( I ) 


COMPUTE LM POSITION VEC R IN INERTIAL SPACE 


DO 30 1*1,3 
LU1»*STATE( I)*M( I ) 


TRANSFORM TO ARTh FIFED COORDINATES 


CALL WET(TIEO.TIE) 

CALL MINV3I T I - ,TE I ) 

CALL MATABITEI .LI . LE.3.3,1) 


SOLVE FOR LATITUDE AND LONGITUDE (DEG) 


LAT«ASIN(LE{ 3)/(RE*AL) ) 

LON*ia0.*ASIN<LE(2)/((RE*AL)»C0S(LAT)))/l»I 

lAT*LAT»1B0. /PI 

RETURN 

END 


ROGCP 
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Pag* 9 


PROGRAM SECTIONS 


Nam* Bytes 

0 SCOOE 505 

1 SPOATA ® 

2 SLOCAL «« 

3 CM T PAR 392 

4 ENVIR 404 

5 ARRAYS 

• TARGETS 3 * 

7 TIME 196 

6 NSTATE ,,a 


At tr i but** 


PIC 

CON 

REL 

LCL 

SHR 

EXE 

RO 

NOMRT 

LONG 

PIC 

CON 

PEL 

LCL 

SHR 

NOEXE 

RO 

NOMRT 

LONG 

PIC 

CON 

REL 

LCL 

NOSMR 

NOEXE 

RO 

NRT 

OUAO 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RO 

MRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

NRT 

LONG 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 

RD 

NRT 

LONG 

PIC 

OVR 

REL 

GBL 

5HR 

NOEXE 

RD 

NRT 

LONG 

PIC 

OVR 

R£L 

GBL 

SHR 

NOEXE 

RD 

NRT 

LONG 


ENTRY POINTS 

Address Typ* Nam * 
0-00300000 ROCCP 


VARIABLES 


> 

1 

Address 

Typ* 

Nam* 

1 

3-00000000 

R*S 

AL 

cr 

7-00000020 

R*8 

DEL 


2-00 300290 

t»4 

I 


6—00 OOOOOC 

L*4 

JFLA3 


6-00000000 

I»4 

NTYPE 


B-00 000060 

r*b 

RADM 


2-00000278 

R*8 

TO 


7-00000000 

R*8 

TIME 


7-00000048 

R*8 

TMEAS 


7-00 000050 

R*B 

TRACK 


Address 

Typ* 

Nam* 

2-00000270 

R*8 

B 

7-00000068 

R*8 

OTA 

4-00000190 

1*4 

IN1T 

3-00000010 

R *8 

LAT 

6-00000008 

1*4 

NS 

8-00030068 

R«8 

RE 

3-00000180 

R<>8 

THET 

7-00000028 

R*S 

TIN 

7-00000008 

R*a 

TNEXT 

7-00000010 

R*8 

TSTOP 


Address 

Typ* 


7-00000038 

R*B 

DATEO 

7-00000030 

R*8 

DTN 

6-00000004 

1*4 

IS 

3-00000008 

R*8 

LON 

6-00000014 

R*8 

PI 

3-00000178 

R*8 

SIGGCP 

2- -.9 000280 

R*8 

THETP 

7-000000 SB 

R*8 

TIS 

6-0000001C 

R»P 

TPI 

7-00000040 

R*8 

T2ERQ 


Address 

Typ* 

Nam* 

7-0000C070 

R*8 

DATER 

7-00000080 

R *8 

DT PRINT 

2-00000294 

1*4 

U 

6—006000 IO 

1 *4 

MCOOE 

8-00000068 

R*8 

RADE 

2-03000288 

R • 8 

sthetp 

7-00000018 

R*8 

TIA 

7-00000060 

R*8 

TISN 

7 -00000078 

R*8 

TPRINT 


ARRAYS 


Address 

Typ* 

Nam* 

Bytes 

0 i mm Iona 

3-00 OOOOCB 

R*8 

BKL 

1C 

(2) 

3-00 0000 A8 

R*8 

BL 

16 

(2) 

2-00 000240 

R*B 

DOWN 

24 

m 

2-00000048 

R*8 

LE 

24 

(3> 

2-00000060 

R*8 

LI 

24 

(3) 

2-00 000078 

R»8 

M 

24 

(3) 

4-0000050 

R*8 

PROFILE 

323 

(10. 4) 

3—00 0000D6 

R*8 

SKL 

1b 

(2) 

3-00000098 

R»8 

SL 

16 

(2) 

4-00000000 

R*B 

STATE 

80 

(10) 

5-00 000000 

R*8 

T 1 

24 

(3) 

5-00 000098 

*•8 

Til 

72 

<3. 3) 

5-00 000018 

R*8 

T2 

24 

(3) 

5-00000030 

R*8 

T3 

24 

O) 

5—0000' ' "0 

R*8 

T33 

72 

(3, 3) 




BOGCP 
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5-00000048 

R*S 

T 4 

80 

( 10 

I 

5-00000128 

P*8 

T 44 

1 25 

( 4 . 

4) 

5-000003F.8 

R*0 

T5 

32 

(4 ) 


5-00000408 

R*e 

T 6 

32 

( 4 ) 


5-00C001 A8 

R*e 

T66 

2 80 

(6. 

6) 

5-00 "00426 

R * 0 

TV 

32 

(4 ) 

5-000002C8 

R • 0 

T77 

288 

(6. 

6) 

2-00 0000^0 

R* 0 

TBI 

72 

( 3 . 

3) 

3-00000018 

R • 8 

TBNL 

72 

< 

3) 

2-00000008 

R«8 

TEI 

72 

C 7 . 

3) 

2-000001 20 

R • 0 

TIB 

72 

( J . 

3) 

2-00000160 

R*0 

TIE 

72 

t 3 . 

3) 

3-00 0001 30 

R • 8 

TIEO 

72 

(3. 

3) 

2-00000000 

R • 0 

TIL 

72 

(3. 

3) 

2-000001 no 

R • 0 

tll 

72 

(3. 

3) 

3-C0 000060 

R* 0 

tnl 

72 

(3. 

3) 

3-00 COOOE8 

R • 0 

TNLK 

72 

(3. 

3) 

2-00000258 

R *fl 

UCD 

24 

( 3 ) 

2-000001 F 8 

R •(a 

UL 

24 

(3) 


2-00000210 

R*0 

JLI 

24 

(3) 


2-00000228 

R*0 

ULL 

24 

( 3 ) 


8-00000030 

R*0 

X 

48 

(6) 


B— CO C00000 

R*0 

XD 

48 

(6) 
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Address Lac * 1 


Address Lao* I 


Address Label 


Address Labe) 


• • 10 


IS 


20 


30 


FUNCTIONS AND SUBROUTINES REFERENCED 
ANAT MATAS M1NV3 

V‘;bs vmag met 


MThSOASIN 


mtmsdcos mthsds I N MTHSOSQRT boot A 


Total Soac* Allocated « 3609 Bytes 


command qualifiers 

FORTRAN /LIST GC P . I NDA T A .MAT AB .OUT DATA . BUNG , DN AV , EPHEM , TRUE A , SPBESS . OCCULT . GPERT , GCPSEQ . VISIBLE . GENENV . TREG.G7 ROU F , RATE . BMAT , CMA 

/CHECK«(NOBOUNOS .OVERFLOM) 

/DEBUG* ! NOSVM60L S .TRAC EBACK ) 

/F7T /NOG.FLOAT ING /I4 /OPTIMIZE /MARN1NGS /NOD.L1NES /NOMACMINE CODE /CONT 1NUATJUNS-19 


COMPILATION STATISTICS 

2.S7 seconds 
31.83 seconds 
395 

ISO pages 


Run Time: 

E I ap sed 7 1 me : 
Page Faults: 
Dynamic Memory: 






8-Apr-1 981 
6-Apr-1 981 


07:42:25 
07:41 : 05 
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0001 



SUBROUTINE TRANFM( XT RANS , X TRANP ) 




C 

this routine creates the tranjFormation matrices for 




c 

TRANS FORMA r ION FROM INERTIAL TO FLIGHT COORDINATES. 


0002 


c 

INCLUDE 'ARRAY COM' 



• 

c 

COMMON BLOCK USED FOR PLOTTING ROUTINE 



* 

c 



0C03 

* 


COMMON /ARRAY/ X( 300 0 . 39 . 2 1 . INUM 


0004 

* 


RE AL*4 X , XI 13000.39) ,X2(3000,39) 


0005 

• 


I N TEGER* 2 INJM 


0006 

• 


EQUIVALENCE ( X 1 ( 1 , 1 ) , X< 1 , 1 , 1 ) ) . C X2[ 1 , 1 ) ,X( 1 , 1 ,2) ) 



• 

c 



0007 



RE AL»8 XTRANS1 3,3,3000) . XTRANP( 3 , 3 , 3000) 


0008 



RE AL*8 UXF( 3. 3000) ,UVF(3. 3000) . UZF(3 , 3000) , TUVF( 3 


0009 



REAL»e X TEMPI ( 3) ■ XTEMP2( 3 ) 




c 

c 

CREATE Uzf 


0010 


w 

DO 10 1*1, INUM 


0011 



XTEMP1 ( 1 )>X( 1 ,34,1 ) 


0012 



XTEMP1 ( 2 ) *X ( 1,35,1 ) 


0013 



XTEMP1 < 3 ) = X ( 1 ,36,1 ) 


0014 



CALL UNIT ( XT EMPt ( 1 ) , UZF ( 1 ,1),3) 


0015 


10 

CONTINUE 

> 



c 


1 

OJ 



c — — 

NEGATE ALL ELEMENTS OF UZF 

u* 

00 

0016 


c 

00 15 1*1, INUM 


0017 



UZF< 1 . I )*-UZF(1 .1 ) 


0018 



UZF ( 2 , I ) *-UZ F (2,1) 


0019 



UZF ( 3 , I )*-UZ F(3, I ) 


0020 


15 

/• 

CONTINUE 




L 

/* 

CREATE Uyf 


0021 


V 

00 20 1*1, INUM 


0022 



XTEMP2 ( 1 )*X< 1,37,1 ) 


0023 



XTEMP2 ( 2 ) *X( 1,38,1 ) 


0024 



XTEMP2 ( 3 ) *X ( 1,39,1 ) 


0025 



CALL VCRS(XTEMP2(1 ) , XTEMP 1 ( 1 ) , TUVF( 1 ,1)) 


0026 



CALL UNIT ( TUVF ( 1 • I ) ,UVF( 1 , 1 ) ,3) 


0027 


20 

CONTINUE 




C 

CREATE Usf 


0026 


c 

00 30 1*1 , INUM 


0029 

0030 


30 

C 

CALL VCRS1 UY F ( 1 , I ) ,UZF( 1 , I ) , UX F ( 1 , 1 ) ) 
CONTINUE 

MERGE INTO XTRANS 




c— 


0031 


c 

00 40 1*1, INUM 


0032 



DO 35 d*1 ,3 


0033 



XTRANSO ,d , I)*UXF(d, I ) 


0034 



XTRANSi 2 i d .1 )*UY F ( d , I ) 


0035 



XTRANS 1 3 , d , I )*UZ F(d , I ) 


THE 


TRANFM 


VAX-11 FORTRAN V2.0-2 
_DBA0‘ [D1 1R.GCP] TRANFM. FOR ; 3 


Page 2 


8-Apr-t 981 
8-Apr-1 981 


07:42: 25 
07:41 : 05 


0036 

35 

CONTINUE 

0037 

40 

C 

CONTINUE 


c — 

CREATE THE INVERSE 

0038 

L 

DO 50 1*1, INUM 

0039 


CALL M INV3{ * TRANS ( 1,1,1) ,XTRANS(1 ,1,1)) 

0040 

50 

C 

c 

CONTINUE 


c — 

r. 

CREATE THE TRANSPOSE 

0041 


DO 73 1*1 , INUM 

0042 


DO 60 J=1 ,3 

0043 


XTRANP(1 , J , I ) «XT PANS (0,1 ,1) 

004C 


ATRANP ( 2 , U , I ) «XT RANS ( J , 2 , I ) 

0045 


xrRANP(3,d,I)«XTRANS( J.3.I) 

0046 

60 

CONTINUE 

0047 

/O 

•' • 5 NUE 

0048 


R- wKN 

0049 


END 


PROGRAM SECTIONS 



Name 

Bytes 

At tr i butPS 







0 

SCCSE 

527 

PIC CON REl 

LCL 

SHR 

EXE 

RD 

NCKRT 

LONG 

1 

SPDATA 

4 

PIC CON REL 

LCL 

SHR 

NOEXE 

RD 

NOWRT 

LONG 

2 

SLOCAL 

288176 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RO 

WRT 

QUAD 

3 

ARRAY 

936002 

PIC OVR REL 

GBL 

SHR 

NOEXE 

RD 

WRT 

LONG 


ENTRY POINTS 

Address Type Name 
0-00000000 TRANFM 


VARIABLES 


Address 

Type Name 

Address 

T ype 

Name 

Address 

2-00046530 

1*4 I 

3-000E4840 

I *2 

INUM 

2-00046534 


ARRAYS 






Address 

Type 

Name 

Bytes 

D i mens i ons 

2-00 034BC0 

R*8 

TUYF 

72000 

(3 , 

3000) 

2-00000000 

R*8 

UXF 

72000 

(3. 

3000) 

2-00011940 

R*8 

UYF 

72000 

(3, 

3000) 

2-00023280 

R*B 

UZF 

72000 

(3. 

3000) 


09 £- 


TRANFM 


8-Apr-1981 07:42:25 
e-Apr-1981 07:41:05 


VAX-11 FORTRAN V2.0-2 
_0BA0: [D1 1R.GCPJTRANFM.FOR ; 13 


Page 3 





3-00000000 

R*4 

X 

936000 

(3000, 

39, 2) 

3-00000000 

R*4 

XI 

4680 00 

(3000. 

39) 

3-00072420 

R*4 

X2 

468000 

(3000. 

39) 

2-00046500 

R*e 

XTEMP1 

24 

(3) 


2-0004651 B 

R*B 

X TEMP 2 

24 

(3) 


AP-OOOOOOOBP 

R*e 

xtranp 

216000 

(3. 3. 

3000) 

A P-00 0000048 

R*8 

xtrans 

216000 

(3, 3, 

3000) 

LABELS 






Address 

Labe 1 

Address 

Label 

Address Lai 

** 

10 

• • 

15 

• • 

20 

• • 

50 

• • 

60 

• • 

70 


Address Label 
** 30 


Address Label 
• • 35 


Address Label 
• • 40 


FUNCTIONS ANO SUBROUTINES REFERENCED 
MINV3 UNIT VCRS 

Total Space Allocated * 1224709 Bytes 

COMMAND QUALIFIERS 

FORTRAN tranfm/lis 

/CHECK* ( NO BOUNDS .OVERFLOW) 

/OE8UG* ( NOSYMBOL S , TRAC EBACK ) 

/F77 /NOG.FLOAT ING /14 /OPTIMIZE /WARNINGS /NOD.LINES /NOMACHINE.COOE /CONT INUATIONS-19 


COMPILATION STATISTICS 

Run Time: 2 
Elapsed Time: 4 
Page Faults: 1 
Dynamic Memory! ! 


2.15 seconds 
4.93 seconds 
187 

59 pages 





i 


Page 


6-Aor-1 981 14:51:32 
28-Nov-19B0 10:43:45 


VAX-11 FORTRAN V2.3-2 
_0BA0: [01 1R. GCR iUNI T . FOR : 1 0 


0001 


0002 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


c* * * 

c 

c* • • 

0003 


0004 

0005 

0006 

0007 

0008 

0009 

0010 


SUBROUTINE UNIT(R.V.N) 

UNITIZE THE V CTGR V|3) 


INCLUDE 'DEBUG.COM' 

• COMMON /DEBUG/ I ENTE R . i DEBUG 

• C 

, q USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

• ~ 1 nter IF 1, PRINTS MHEN ENTERS MOST SUBROUTINES 

, q IOEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

• C 

C DIMENSION R(N ) . V(N ) 

DIMENSION R{ 22) , V( 22) 

REAL*B D.R.V.VMAG 
D « VMAG(R.N) 

DO 10 I« 1 ,N 
10 V ( I ) ■ R(I)/0 
RETURN 
END 


PROGRAM SECTIONS 




Name 

> 



1 

0 

SC ODE 

O' 

2 

SLOCAL 


3 

DEBUG 


Bytes 

At t r j butes 







87 

PIC CON SEL 

LCL 

SHR 

EXE 

RD 

NOWRT 

LONG 

64 

PIC CON REL 

LCL 

NOSHR 

NOEXE 

RD 

WRT 

QUAD 

8 

PIC OVR REL 

SBL 

SHR 

NOEXE 

RO 

WRT 

LONG 


ENTRY POINTS 


Address Type Name 
0-00000000 UNIT 


VARIABLES 

Address Type 

Name 

Address 

Type Name 

Address 

Type 

Name 

Address 

T ype 

N ime 

2-00000000 R*8 

i 

0 

2-00000008 

I *4 I 

3-00000004 

1*4 

I DEBUG 

3-00000000 

1*4 

IENTER 

AP-00 OOCOOCM 1*4 

N 










ARRAYS 

Address Type Name 

AP-00000004* R*8 R 
AP-oooooooaa R*e v 


Bytes Dimensions 

176 (22) 

176 (22) 


-362 


IS 


UNIT 


LABELS 

Address Labe 1 
** 10 


6-Apr-l98i 14:51:32 
28 -Nov- I960 10:43:45 


VAX-11 FORTRAN V2.0-2 
_DBA0: [Dl 1R.GCP] UNIT. FOR; 1 0 


Page 2 


FUNCTIONS and subroutines referenced 

VMAG 


Total Space Allocated « 159 Bytea 


COMMAND QUALIFIERS 




/DEBUG* (NO SYMBOL S , TRACE BACK ) 

/ " 00 - ,L0 ‘ ,, "° /0,, "" 2e *UW /*.M»I«_a>OE /CONI IMJATIONS" is 

COMPILATION STATISTICS 


> 


Bun Time: 
Elapsed Time: 
P«0« Faults: 
Dynamic Memory: 


0.59 seconds 
8 • 42 seconds 
333 

160 pages 


p 




6 * Adi — 1 9b 1 1 5 ; C5 : 5 1 VAX-11 FORTRAN ^2.0-2 PaQ-T 

1 1 -Sep- 1 980 12:03=32 _DBA0 : [ D 11 R . GC R I VCR3 . FOR ; 4 


0001 

0002 

00100 

00200 

0J300 

OL400 

00500 

00600 

00700 


SUBROUTINE VCRS(A.B.C) 

INCLU0E 'DEBUG. COM’ 

0003 • common /DEBUG/ ienter. .debug 


• c 

• c 

• c 

• c 

• c 

• c 

0004 

0005 


USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

I NT£R IF 1. PRINTS WHEN ENTERS MOST SUBROUTINES 
I DEBUG 0-10, HIGHER NUMBER MEANS MORE PRINT 

DIMENSION A(3) .8(31 .03) 

RE AL»0 A , B.C 


C 

C VECTOR CROSS PRODUCT (A) X (B) ■ (C) 


C 


0006 

cm * 

A ( 2 ) *B( 3 ) - A ( 3 ) * B ( 2 ) 

0007 

C( 2) • 

A ( 3 ) *B( 1 )-Ai 1 ) ♦ B1 3 ) 

0008 

C< 3) * 

A ( 1 ) *B( 2 )-A i 2 ) ’ B( 1 ) 

0009 

RETURN 


0010 

END 



PROGRAM SECTIONS 


Name 


0 SC ODE 

2 SLOCAL 

3 DEBUG 


Bytes Attributes 

106 PIC CON REL LCL SHR EXE RD NOWRT LONG 

60 PIC CON REL LCL NOSHR NOEXE RD WRT LONG 

8 PIC OVR REL GBL SHR NOEXE RD WRT LONG 


ENTRY POINTS 


Address type Name 
0-00000000 VCRS 


VARIABLES 


Address Type Name 


Address Type Name 


3-00000004 I *4 IOEBUG 3-00000000 1*4 I ENTER 


ARRAYS 

Address Type Name 

A P— 00000004a R*8 A 

AP-OOCOOQ08# R*0 8 

AP-OOOOOOOC* R*8 C 


Bytes Dimension* 

24 ( ~ ) 

24 (o) 

24 (3) 


Total Space A 11 oca tad « 174 Bytaa 


.-364 


VCRS 


VAX-11 FORTRAN V2.0-2 
.OBAO: [D1 1R.GCP] VCRS. FOR: 4 


Page 2 


6"Apr-1 981 15:05:51 
11 -Sep-1 980 12:03:32 


COMMAND QUALIFIbRS 

FORTRAN /LIST GC P . INDA T A , MAT AB. OUT OATA . RUNG . DNAV , EPHEM. TRUEA.SPRESS .OCCULT . GFERT . GCPSEQ. VISI BLE .GENENV . TREG.GVROUT .RAT E , BMAT , CMA 

/CHECK* (NOBOUNOS .OVERFLOW) 

/DEBUG* ( NOSYMBOL S , TRACEBACK ) 

/F77 /NOG _ FLOAT If.‘G /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE.COOE /CONT INUAT IONS-1 9 


COMPILATION STATISTICS 

Run Time: 0.63 seconds 

Elapsed Time: 10.88 seconds 

Page Faults: 165 

Dynamic Memory: 160 pages 


> 


6-Apr-1981 15:06:03 
1 -Dec-1980 07 : 1 A : 24 


Page 


VAX-11 FORTRAN .2.0-2 
_DBA0 : [D1 IR.GC^ JVCOT . FOR : 7 


0001 


0-02 

00100 

00200 

00300 

00400 

00500 

00600 

00700 


c* • • 

c 

c • ♦ * 

0003 


0004 

0005 

0006 

0007 

0008 

0009 

0010 


FUNCTION VDOT (A, 8 , N ) 

VECTOR DOT PRODUCT (A) DOT (81 = VDOT 


INCLUDE 'DEBUG.COM' 

• COMMON /DEBUG/ I EN T E R . I DE BUG 


• c USER CONTROLLED PARAMETERS TO VARY DEBUG PRINT LEVEL 

• C 

. c I NTER if 1, PRINTS WHEN ENTERS MOST SUBROUTINES 

. c I DEBUG 0-10. HIGHER NUMBER MEANS MORE PRINT 

• C 

C OIMENSION A(N ) ,B( N) 

DIMENSION A( 22 ) . B( 22 ) 

RE AL*8 VDOT. A. 8 
VDOT * 0. 

DO 10 I«1.N 

10 VOOT « VDOT+A( I )»B( I ) 

RETURN 

END 


PROGRAM SECTIONS 

Name Bytes Attributes 

76 PIC CON REL LCL SHR EXE RD NOWRT LONG 

52 PIC CON REL LCL NOSHR NOEXE RD WRT QUAD 

8 PIC OVR REL GBL SHR NOEXE RD WRT LONG 

ENTRY POINTS 

Address Type Name 
0-00000000 R«a VOOT 


0 SCOOE 

7 2 SLOCAL 

cj 3 DEauG 

O' 

Ln 


VARIABLES 

Address 

Type 

Name 

Address 

Type 

Name 

Address 

Type 

Name 

Address Type Name 

2-00000008 

1*4 

I 

3-00000004 

I *4 

I DEBUG 

3-00000000 

1*4 

1ENTER 

AP-0000000C* 1*4 N 


ARRAYS 

Address Type Name 


By tes Dimensions 


A P-00 000004V R»8 
AP— 00 000006V R*8 


A 

8 


1 76 
1 76 


( 22 ) 

( 22 ) 


-366 


VOOT 


Pag* 


a 


LABELS 


6-Apr-1981 15:06:03 
1-DK-1 980 07M4:24 


VAX-11 FORTRAN V2.0-2 
_DBA0:[D1 1R.GCP]VD0T.F0R:7 


Address Lab* 1 
•* 10 


Total Space Allocated ■ 136 Byt*a 


COMMAND QUALIFIERS 

fortran /list gcp, inoata.matab, out data, rung, dnav.ephem, truea.spress, occult .gpert.gcpseq, visible .genenv. treg.gyrout, rate, bmat.cma 

/CHECK* ( NOBOUNOS .OVERFLOW) 

/DEBUG* < NOSYMBOLS. TRACEBACK) 

/F77 /NOG .FLOAT I NG /I4 /OPTIMIZE /WARNINGS /NOO.LINES /NOMACHINE CODE /CONTINUATIONS-lfl 


COMPILATION STATISTICS 

Run Tim*: 0.59 seconds 

Elapsed Ttai*: 15.48 seconds 

Pag* Faults: 280 

> Dynamic Memory: 160 pages 


6 -Apr- I ^8 1 15:06:20 
t-Dec-*, 980 07:15:24 


Page 


VAX-11 FORTRAN .2.0-2 

_DBA0:[D1 1 R . GC p 1 VMAG . FOB : 5 


0001 


c* • • 

c 

c* • • 

0002 

00100 0003 

00200 
00300 
00400 
00500 
00600 
00700 

0004 

0005 

0006 
0007 


FUNCTION VMAG(A.N) 

ABSOLUTE MAGNITUDE OF AIN| VECTOR 


INCLUDE 'OE8UG.COM' 

• COMMON /DEBUG/ I EN T £ R . ; DEBUG 

• C 

• C USER CONTROLLED parameters to vary debug print level 

• c 

• C I NTER IF 1, PRINTS WHEN ENTERS MOST SUBROUTINES 

• C IOEBUG 0-10, HIGHER NUM'.ER MEANS MORE PRINT 

• C 

REAL'S VMAG.A.VOOT 
VMAG • SQRT( VDOT( A, A ,N) ) 

RETURN 

END 


PROGRAM SECTIONS 
N a me 

0 SCOOE 

2 SLOCAL 

3 DEBUG 


Bytes Attributes 

38 PIC CON REL LCL SHR EXE 

24 PIC CON REL LCL NOSHR NOEXE 

8 PIC OVR REL GBL SHR NOEXE 


RD NOWRT lDNG 
RO WRT QUAD 
RD WRT LONG 


ENTRY POINTS 

> Address Type Name 
? 0-00000000 R*B VMAG 


VARIABLES 

Address Type Name 
A P-00 0000049 R»B A 


Address Type Name 
3-00000004 1*4 IOEBUG 


Address Type Name 
3-00000000 1*4 I ENTER 


Address Type 
A P-000 CO 0089 1*4 


FUNCTIONS ANO SUBROUTINES REFERENCED 
MTHSOSQRT VOOT 


Name 

N 


Total Space Allocated ■ 70 Bytea 


A- 368 


VMAG 


6-Apr- 1 981 15:06:20 
1 -Dec— 1 980 07 : 15:24 


WAX-11 FORTRAN V2.0-2 
_DBA0: [01 IR.GCPJVMAG. FOR: 5 


Rag* 


COMMAND QUALIFIERS 


FORTRAN /LIST GC P , INOA T A .MAT AB.OUTOATA 


RUNG. ONAV.EPHEM.TRUEA.SPRESS, occult. gpert.gcpseq. VISIBLE 


/CHE CK « ( NO BOUNOS , OV ER F LON ) 

/DEBUG’ ( NOSYMBOL S , TRACEBACK) 

/F77 /NOG .FLOATING /I4 /OPTIMIZE /WARNINGS /NOO_LlNtS /NOMACHlNE.COOE 


/C0NTINUATI0NS-19 


.GENENV.TREG.GTROUT.RATE.BMAT.CMA 


COMPILATION STATISTICS 

0.45 seconds 
10.41 seconds 
279 

160 pag*s 


Run Tim*: 
Elapsed Tim*: 
P*0* Faults: 
dynamic Memory! 


6-*pr-l381 14:55:45 

28-Oct-l 900 1 1 : J1 :32 


VAX-11 FORTRAN V2.0-2 
_DBA0: [01 1R.GCP ',WET . FOR: 5 


Page 


00100 

0001 

00200 


0C300 


00400 


00500 


00600 


00700 


01000 


01100 


01200 


01300 


01400 


0150C 


01600 


01700 


0 1 BOO 


01900 


02000 


02050 

0002 

00100 


00200 

0003 

00 300 


00400 

0004 

00500 


00600 


00700 


00800 


00900 


01000 


01100 


01200 


01300 


01400 


01500 


01600 


01700 


01 BOO 


01900 


02000 


02100 


02200 


02300 


02400 


02500 


02600 


02100 

0005 

02200 

0006 

02300 

0007 

02305 


02310 


02315 


02320 

oooa 

02325 

0009 

02330 


02335 


02340 


02400 

0010 


C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

C' 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 


c 

c 

c 


subroutine wet< tieo, tie» 


subroutine net creates the transformation from earth 
FIXEO TO inertial coordinates 

INPUT VARIABl S 

TIEO * INITIAL TRANSFORMATION 

OUTPUT VARIABLES 

TIE * EARTH FIXEO TO INENiILL TRANSFORMATION 

AT TIME T 

PROGRAMMED B V JACK MYERS 16JUNE1980 
E X T 4443 


IFCLUDE 'TIME.COM' 

COMMON /TIME/ TIME. TNEXT. TSTOP. TIA, del. tin, DTN.DATEO.TZERO 

.TME AS. TRACK . T I S , T ISN. DT A . OATE R . T PR I NT . DTPR I NT 
REAL'S TIME.TNEXT . TSTCP. T 1 A.DEL . T IN . DTN . DAT EO . TME A S , TRACK ,TIS 
TISN.DTA.TZERO.DAIER.TPRinT.DTPRINT 

THESE ARE THE TIME REFERENCE FRAMES 

TIME ATOMIC TIME SINCE INITIALIZATION (SEC) 

TNEXT TIME FOR NEXT POSITION INTEGRATION (SEC) 

TSTOP RUN TERMINATION TIME (SEC) 

TIA ATTITUDE INTEGRATION TIME (SEC) 

0 L ‘ ' STEP SIZE (SEC) 

TIN POSITION INTEGRATION TIME (SEC) 

gtn - - STEP SIZE (SEC) 

DATEO DATE OF FLIGHT EPOCH (JO) 

DATER DATE OF 1950 EPOCH (JD) 

TZEBO START TIME IN SECS. SINCE DATEO 

TSLEP time NEEDED TO SLEW AND ACQUIRE (SEC) 

TIS REAL WORLD REFERENCE TIME (SEC) 

TISN TIME FOR NEXT RW POSITION INTEGRATION (SEC) 

DTA USUALLY ♦ DEL BUT ♦ TSLEW - TIA WHEN DEL 

TOO large AT MEASUREMENT TIME 
T PR I NT TIME FOR PRINT (SEC) 

OTPRINT INCREMENT on T PRINT (SEC) 

DATA WE/7.292M52E-5/ 1RA0/SEC 
DIMENSION A( 3.3) 

REAL'S TIE.TI 0 . WE . A . OJOS . TE 


COMPUTE TIME CHANGE SINCE DATE R'JANUART 1 1950 


DJDS*24 . *360 0 . • ( DA T EO-DA TER ) 

TE*DJDS»TZERO»i IME 

SET UP TRANSFORMATION FOR ROTATION SINCE DATER 


DO 10 I«1.3 


p*we a 


MET 



02500 

0011 


02600 

0012 

10 

02700 

0013 


02800 

0014 


02900 

0015 


03000 

0016 


03100 

001? 


03110 


C«< 

03120 


C 

03130 


C*< 

03200 

0016 


03300 

0019 


03400 

0020 



DO 10 J-1 ,3 
A( 1 .J) >0. 

A ( 1 . 1 ) «C0S(ME*TE) 

A( 1.2)>-SIN(M »TE) 

A( 2. 1 | 1.3) 

A(2,2)*A(1,1 ) 

A( 3 , 3 ) • 1 . 

SET UP TOTAL TRANS FORMAT ION 

CALL MATABU.TIE0.TIE.3.3.3) 

RETURN 

EMO 


6-Ach — 1 901 14:55:45 

2B-Oct-19BO 11 .’31:32 


VAX-11 FORTRAN V2.0-2 
_DBA0: (DIIR.GCP)HET. FOR: 5 


PROGRAM SECTIONS 




0 SCOOE 

1 SPOATA 

2 SLOCAL 

3 TIME 


C ENTRY POINTS 


Bytes 

Attributes 




149 

PIC 

CON 

REL 

LCL 

Cub 

aTTN 

EXE 

4 

PIC 

CON 

REl 

LCL 

040 

•TIN 

NOEXE 

132 

PIC 

CON 

RIL 

LCL 

NOSHR 

NOEXE 

136 

PIC 

OVR 

REL 

GBL 

SHR 

NOEXE 


RD NOMRT LONG 
RO NOMRT LONG 
RO MRT OUAO 
RO MRT LONG 


Address Type Name 
0-00000000 MET 


variables 

Address Type Name 

3-00 00 00 30 R*0 OATEO 

3-00000060 R*S OTA 

2- 00000064 1*4 J 

AP-00 0000040 R*B TIEO 

3- 00000060 R*0 TISN 

3-00000050 R*0 TRACK 


ARRAYS 


Nrms 

A 


Address 

T ype 

Naae 

3-00000070 

R»B 

DA TER 

3-00000030 

R*8 

OTN 

2-000C0058 

R»8 

TE 

3-00000000 

R*6 

TIME 

3-00000018 

R*8 

tmeas 

3-00000010 

R*B 

TSTOC* 


Bytes Dt Mansions 
72 (3. 3) 


Address 

Type 


3-00000020 

R«B 

DEL 

3-00000080 

R*8 

0TPR1NT 

3-00000018 

R-B 

tia 

3-00000028 

R*8 

TIN 

3-00000008 

R*8 

TNEXT 

3-00000040 

R*8 

T2ERO 


Address 

Type 

Saw 

2-00000050 

R *8 

DUOS 

2-00000060 

I *4 

I 

AP -000000086 

R«8 

TIE 

3-00000058 

8*8 

TIS 

3-00000078 

R*8 

TPRINT 

2-00000048 

R*S 

ME 


Address Type 
2-00000000 R*R 


-37 


NET 


6 -Apr - 1 981 14:55:45 
2B-Oct-1980 11 : 3 1 : 32 


VAX-11 FORTRAN V2.0-2 
_D9A0: tOHR.GCPl*ET. FORlS 


Pag* 3 


LABELS 

Address Lab# 1 
.. 10 

FUNCTIONS AND SUBROUTINES REFERENCED 
MATAS MThSOCOS MTMSOSIN 

To:a1 Space Allocated ■ *21 Bytaa 


COMMAND qualifiers 

FORTRAN /LIST GCP 


INDATA, MAT AB.OUTOATA. RUNG. DNAV 


EPM EM. TRUE*. SPRESS. OCCULT. GPERT 


GCPSEQ. VISIBLE. GENENV.TREG.GTROUT. RATE, BMAT.CMA 


/CHE CXH NO BOUNDS .OVERFLOW) 

/DEBUG* ( NOSTMBOL S . TRACEBACM 

/F77 / nog _ float ing /i* /optim.ze 


/warnings /noo.uhes /noma chine _COOE 


/C0NTINUATI0MS-19 


compilation statistics 

Run T,ma: 0 • 9B second* 

Elapsed Tima: 13. 6 T second* 

Pag* Fault*: 346 

Dynamic Memory: 1B0 pages 


3.0 SIMULATION MODE 2 

The second mode of GCF3IM operation provides for extraction of GCP's 
directly from LANDSAT imagery. The main portion of GCPSIM is identical to 
that discussed previously. The primary difference is that several additional 
programs are hosted on the PDP 11/70 and communicate with GCPSIM, which is 
hosted on the VAX 11/780, through a parallel link (Figure A-45). 

Two primary programs exist. The first called LMEX allows a landmark 
data base to be constructed independently from GCPSIM. The other main 
program performs the scrolling of the imagery, extraction of imaga data, 
and correlations from the stored GCP. These two programs are discussed 
separately in the following sections. 



VAX 


PDP 11/70 


Figure A-45. Implementation Strategy of GCPSIM 
Landmark Extraction Mode 
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3.1 LANDMARK (GCP) EXTRACTION PROGRAM (LMEX) 

The Landmark Extraction Program, LMEX, was written to allow the user 
to interactively extract ground control points from LANDSAT imagery. These 
extracted GCP's will be used for correlation purposes on later LANDSAT 
imagery of the same area. 

LMEX created a data base that will be used with the correlation-scroll 
programs. LMEX can create a new data file or can be used to modify an 
existing data file. 

The landmark data base file is a direct access file of record size 
256 bytes. The user can name this file any name desired. The file set 
up is as follows: 


Header block 
(4 records) 


Landmark data 
(1 record per 
landmark) 


The first four records are header records containing information about 
each extracted landmark. Each landmark extracted uses up 16 bytes of 
header space, therefore up to 63 landmarks may be extracted. Word -1 of 
the header contains the number of landmarks in the data base. Each land- 
marks image data consists of 256 bytes- This allows each landmarks data 
to be stored in one record. 

The LANDSAT imagery is displayed on a RAMTEK 9100 B/W graphics display 
system. The data displayed is either 7-bit or 6-bit grey scale imagery. 

The data being displayed will be scrolled from the bottom of the screen to 
the top, thus simulating the satellite motion. 

The user may run LMEX on a previously stored landmark data base or 
create a new one. Landmarks may be defined at any time by using the joy- 
stick. The only restriction on landmark definition is that adjacent land- 
marks must be at least 200 lines apart. The LMEX programs checks for this 
occurring and will not allow it. 
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LMEX 


Is this a new data base file to be used? > 


Initialize landmark no. & other Read in the landmark no. and 
variables as well as the header header information 


Get a line of image data and scroll it 


Is a previously-defined landmark on the screen? 


Draw a box around the l.m. 



\ Does the user wish to define a landmark? 


Allow the user to position a cursor at the 
center of the landmark 


Determine header offsets and other landmark 
information 


Determine where in the header this landmark fits 


Is this a valid landmark? 


Store the landmark data & header 


Draw a box around the landmark 



Do until all the lines of imagery have been scrolled and the 
user wishes to exit 


Write beck the updated header block 















3.2 CORRELATION - SCROLL PROGRAMS 

The correlation-scroll programs consist of three separate tasks. These 
tasks are installed and run concurrently. Inter- task communication is 
performed by using a shareable global area. Inter-task sychronization is 
performed by using global event flags. The three tasks ares 

(1) SCRLL - This tasks scrolls the image data. 

(2) SCOUNT - This tasks updates the landmark data base and decides 

when a correlation is to be performed. 

(3) CORR - This task performs the actual corrleation and returns 

the registration vector. 

These tasks run at different priorities. SCRLL is set at the highest 
priority, next is SCOUNT, and finally CORR. SCRLL will scroll a line of image 
data, signal for SCOUNT to become active, and then suspend itself until SCOUNT 
reawakes SCRLL. SCOUNT in turn, determines whether to awake CORR to perform 
landmark correlation. 

The inter-relationship of the tasks may be seen in Figure A-46 
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CORRELATION - SCROLL PROGRAM STRUCT! RE 
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3.2.1 SCROLL PROGRAM (SCRLL) 


The SCRLL program is the driver task for the correlation-scroll programs. 
This program starts the other two tasks running. This program will then begin 
scrolling image data. After each line of image data is displayed and 
scrolled, SCOUNT will be nctivitated and SCRLL will suspend itself. SCRLL 
will then be activated by SCOUNT when SCOUNT has finished performing its 
function. 


if 


A— 3 7 7 


Reset The RAMTEK 9100 


Set event flag 40. Reset flags 41 and 42. 


Get the name of the linage file to scroll & the starting element 


Create a shareable global and an address window for mapping 
purposes 


Start up SCOUNT and CORR to become active 


Open the Image data file. Set line counter. 


Get no. lines to be scrolled from GCPSIM 


Do until end flag from GCPSIM 


Walt until event flag 40 is set 


Get a line of imagery and display it 


Scroll the Image , simulating motion 


Clear event flag 40. Set event flag 41 to start 
SCOUN'i processing. 


Do while lines of imagery still need to be scrolled 


Set the end flag and set event flags 41 and 42 


Exit task off 


















3. 2. 1.1 DRAW A BOX (DRAW) 

DRAW perform* • similar operation as the DRABOX ^ lbr * r y D8AM 

. rt „ 1H w. u _ ed tbe imagery that is to have the box drawn has been 

scrolled. The differences between DRAW and DRABOX have to do with the 
RM9100 ' s window and scan parameters. 

The passed auguments I and J define the upper left comer of the area to 
.... tt.Tox .nclST lb. box i. .1«I. 18 b, 18 pix.l., tbu. ..clo.xn, • 16 

X 16 pixel landmark. 

FORMAT: CALL DRAW (I-J) 


DRAW 

DRAW THE TOP LINE 

DRAW THE BOTTOM LINE 
DRAW THE LEFT LINE 
DRAW THE RIGHT LINE 


r 


i 


Figure A-49 
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3.2.2 SCROLL COUNTER (SCOUNT) 

SCOUNT is the main data base handler for the correlation-scroll programs, 
this program keeps track of the number of lines that have been scrolled and 
whether or not a landmark has become visible. If a landmark is visible, this 
program waits unitl the entire search area is visible and then activites the 
landmark correlation program GORR. 

SCOUNT is activated by SCRLL when event flag 41 is set. After each line 
of image data has been scrolled, SCOUNT will be activated to perform its 
checking and then deactivate itself and activate SCRLL to begin the process 
over. 
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S COUNT 


Create an address window to map into the shareable global area 


Read in the landmark data base header 


Set up counter for first landmark 


Suspend until event flag 41 is set 


Decrement the landmark counter by 1 


Is the counter greater than 0? 


Is the counter 4 0 


Get the search area size and set counter 


Read in the target landmark data 


NULL T 



Decrement the search area counter by 1 


Is the search area counter equal to zero 


Reset the counter to the next search area 


Set event flag ':2 to begin correlation 




Read in a line of search area image data 


Do until the end flag is set 


Exit task off 









3.2.3 CORRELATION (CORR) 

CORR is used ir conjunction wito 6 COUNT to perform the correlation 
analysis on the LAND SAT imagery. COLR returns the relative registration 
vector of the beat fit of the lankmark imagery upon the target search area 
imagery. 

CORR waits for event flag 42 to be set before any procesaing occurs. 

SCOUNT is the task which will set this flag. Wien 8 COUNT seta this flag, the 
known landmark imagery has been stored in the array LM and the target eearch 
area image data ia in the array WIN. 

The 88DA algorithm usea an exhauative search of the landmark data versus 
the search area data. The best fit is where the correlation value determined 
by the S.S.D.A algorighm is at a minimum. The 8.S.D.A algorithm is: 

# of lines it of elements 

Z Z abs (WIN ( J , I ) -WINDO MEAN ;-(LM( J, I) -LANDMARK MEAN)) 

I - 1 J - 1 

Once CORR has determined the best fit landmark placement, the tasks 
suspends Itself until SCOUNT starts it up again. 
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Create an address window to map Into the shareable global area 


Suspend until event flag 42 is set 


Calculate the mean of the known landmark data 


Using the SSDA correlation, find the best fit location of 
the landmark on the target search area 


Draw a box around the best fit 


Reset event flag #42 


Do until the end flag is set 










3. 2. 3.1 SSDA CORRELATION ROUTINE (CSDA) 


CD8A iapleaants the SSDA correlation algorithm. This routine exhaustively 
calculates the correlation valuea for • known landaark veraua a target search 
area. The beat fit ia where the correlation value ia at a ainiaua. 

The algoritha ia: 

# of lines # of elements 

£ £ abs (WIN (J, I) -WINDOW MEAN) -(LM(J, I) -LANDMARK MEAN)) 

I - 1 J - 1 

FORMAT: CALL CSDA (WIN,LAMMRK,WM,Uf ,N,BFB,BFL,M) 

WIN “ contains search area imagery 

LAttiRK ■ contains landaark area imagery 

WM " search area mean 

LM ■ landaark mean 

N * landaark sise in pixels 

BFE - relative best bit eleaant 

BFL - relative best fit line 

M “ search area sise 


Sec the best fit line and element to 1 


Determine the search area mean 


Set the correlation to 0 


Determine value and add Into this placements 
corr. value 


Do for the no. of elements in the landmark 



Do for the no. of element placements 


Do for the no. of line placements 







3.3 LIBRARY ROUTINES 

The library routines are thoae routines which perform a general function 
without being strictly I/O routines. These subroutines are: 

1 . DRABOX 

2. MEAN 

3. POS 
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3.3.1 DRAW A BOX (DRABOX) 

Th* DRABOX routine draw* a square box sited ISIZB x 1SXZE. INKTBNS 
defines the intensity that this box is to be written at on the RM9100. IX and 
IY define the upper left hand corner of the data to be enclosed by the box. 
IBUF is a scratch array. 





FORMAT: CALL DRABOX (INTENS, ISIZE,IX,IY,IBUF) 

Restrictions: 0<ISIZE<6> 


DRABOX 


Initialize the scratch array to the output 
intensity 


Write the box on the RM9100. 


! 

1 


Figure A-53 


I 


i 
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3.3.2 DETERMINE THE MEAN (MEAN) 


The subroutine MEAN calculates tbs Bean of a group of array elements. Tbe 
array IARRAY (eleaent, Una) contains tbe data values. IARRAY is a aqua**, 2 
dimensions l array. RWM is tbe calculeted aean value. I81ZE is the ° £ 
eleaents and lines to be used. IBS and 1LS are the offsets into IARRAY fro. 
where tbe mean is to be taken. 


'.ORMAT: CALL MEAN ( IARRAY, RWMSNA, ISIZE, ILS , IE8 ) 
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Initialize mean to zero 


Sum up next element to previous sum 


Do for the number of elements 


Do for the number of lines 


Divide the total sum by the number of elements x the number 
of lines 


[ 


Figure A-54 


► 


I 

I 
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J.3.3 POSITION CURSOR (POS) 

POS i« used to allow the uaar to position the cursor on the RH9100 
screen. This routine allows a 9 x 9 pixel cursor to be drawn and moved around 
bf the user. When switch 4 is flipped up , then down, the user has positioned 
the cursor to the desired location and control is returned to the calling 
routine. 


IX and IY are the initial location of the center of the cursor, 
also recieve the final values of the cursor center. ILSTRT, ILSTOP, 
and IESTOP define a rectangular area in which the cursor may move. 

( 0 , 0 ) 

• 


IX and IY 
IESTRT 



(IESTRT, ILSTRT) 


y CURSOR 
WINDOW 




(IESTOP, ILSTOP) 


FORMAT: CALL POS (IX, IY, ILSTRT, ILSTOP, IESTRT, IESTOP) 
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is 



Figure A-55 
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3.4 I/O ROUTINGS 

The I/O routines are those routines which are used strictly for I/O 
purposes. These routines are: 



Subroutine Name 

1 . 

ADJDAT 

2. 

INI JOY 

3. 

RAMRDB 

4. 

RAMWRB 

5. 

READJY 

6. 

RESET 

7. 

RMCHCK 

8 . 

RMRDIM 

9. 

RMSET 

10. 

RMSETO 

11. 

RMWRIM 

12. 

WIO 
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3.4.1 JOYSTICK I/O ROUTINES 

The joystick device on the PDP 11/70 is terminal number TT4: . The 
joystick routines read this terminal and interpret the data. For data to be 
sent from TT4s, one of the switches marked 1 through 4 must be switched up. 
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3.4. 1.1 ADJUST DATA (ADJUST) 

The ADJUST aubroutine ia written in DEC MACRO aeeeably language. Tbia 

routine adjuata the bite in the output data fro* the lhl# routi "! 

ia device dependent and called only by the subroutine READJY. The aource code 

for ADJUST ia found in the file ADJDAT.MAC. 




3.4. 1.2 INITIALIZE THE JOYSTICK (INIJOY) 


Tb« INIJOY aubroutine aaaigna a logical unit nuaber to the joyatick. Thia 
aubroutine ia called once. 

The parameter ILUN ia the logical unit nuaber to aaaign the joyatick to. 
Thia unit nuaber will be uaed by the routine READJY, to read the joyatick 
device. 


FORMAT: CALL INIJOY (ILUN) 



3.4. 1.3 READ THE JOYSTICK (RKADJY) 


The RKADJY subroutine allows the user to reed the joystick. Pour words 
will be returned on each call. These words will be the switch word, X, Y, and 
Z words. The X, Y, and Z words have a rants between 0 and 1023. Wien the 
stick is in detent the X and Y words are 512. Wien the stick is up in the 
upper left corner the X and Y words are 0. The Z word is set by the joystick 
knob. The switch word is bit oriented and follows this convention: 


Bit Location 15 14 13 12 


Switch Location 


11 10 9876543210 

X X X X 
4 3 2 1 


SWITCH WORD 


If bit 0 is set switch 1 is up. It bit l is set, switch 2 is up, and so 
on. There are 4 switches. 

The IWRDCT parameter wust always be 4. ABUPP is the buffer to receive the 
4 words of output. ILUN is the logical un*> number of the joystick as 
initialised by INIJOY. 

FORMAT: CALL RKADJY (ABUPP, IWRDCT, I LUW) 
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3.4.2 RAMTEK 9100 I/O ROUTINES 

All RM9100 I/O routines uh th« WTQIO and GETADR ayatan I/O aubroutinaa. 
The baaic atructura for a RM9100 I/O routine ia tha followingi 

1. Tha command instruction ia placad in a buffer. 

2. The addreaa of the command buffer and the length of the buffer ia 
stored in a parameter array. This ia where CETADR ia used. 

3. Depending on the function, the appropriate data from the parameter 
array is written/read to the RM9100. The operation of 
reading/wr iting is performed by using a WTQIO. 

Two auxiliary routines that have been used by all RM9400 I/O subroutines 
are WIO and RMCHCK. These routines have been developed so that all I/O 
functions will utilize them and help conserve task apace. 
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3. 4. 2.1 RM9100 READ IMAGE WINDOW (RAMRDB) 


Th« RAMRDB aubroutina allova the user to rood a rectangular area fro* the 
SM9100 woty. This rectangular area ia defined by tba calling routine by 
setting IXSTRT , IX8TOP, IY8TRT and IYSTOP. Op to 2000 pixala nay bn raad in 
any ona call to RAMRDB. I8CAM dafinaa tba scan diraction of tba raad. IDATA 
ia tba array in uhich data will bn raad and IUtt ia tba p unbar of pinala to 
raad into IDATA. 


FORMAT: CALL RAMRDB ( I8CAN , IX8TRT , IXSTOP , IY8TRT , IT8TOP , IDATA , IL1B ) 
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3. 4. 2. 2 RM9100 WRITE IMAGE WINDOW (RAMWRB) 

The RAMWRB aubroutine allow* the uaar to writ* a ractangular araa to the 
RM9100 memory. Thia roctrngular araa la dafinad by tha calling routina by 
aatting IXSTRT , IX8TOP, IYSTRT , and IYSTOP. Up to 2000 pixala may ba written 
in any ona call to RAMWRB. I8CAN ia tha acan direction of tha write. IDATA 
ia the array containing ILEN number of pixel* to ba written. 

FORMAT: CALL RAMWRB (ISCAN, IXSTRT, IXSTOP, IY8TRT , IYSTOP, IDATA, ILEN) 


3.4. 2. 3 RESET THE RM9100 (RESET) 

Tbe RESET instruction it an RM9100 system clear function identical to the 
power-on (or bard reset) initialisstion sequence. All pending operations are 
discarded. Tbe refresh memory will be erased. 


FORMAT: CALL RESET 
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3. 4. 2. 4 CHECK RM9100 I/O (RMCHCK) 

Th® RMCHCK aubroutina check® to aa® if th® pr®viou® RM9100 I/O wae 
correctly handled by th® RM9100. Th® ®t«tu® word® ®r® contained in tb® connon 
block 10. The directive atatu® word, IDS, ia ®qu®l to 1 if th® directive w®® 
a«nt aucceaafully . Th® I/O atatua word, IOST(l), i® 1 if th® ia®u®d I/O 
executed correctly. If eithar of thee® variable® do not equal 1, the I/O wa® 
unaucceaaful. 


FORMAT: CALL RMCHCK 


3. 4. 2. 5 RM9100 READ IMAGE (RMRDIM) 

The RMRDIM subroutine allows the user to read a rectangular area from the 
RM9100 memory. Up to 2000 pixels may be read in any one call to RMRDIM. The 
default window of the entire screen is used. 

ISCAN determines the primary and secondary scan directions. 

ISCAN ■ 0 primary - left to right 

secondary - top to bottom 

ISCAN " 4 primary - top to bottom 

secondary - left to right 

IXS and IYS are the element and line values in memory at which the read is 
to begin. IDATA is the buffer in which data ia to be filled and ILEN is the 
number of pixels to be read. 

FORMAT: CALL RMRDIM (ISCAN, IXS, IYS, IDATA, ILEN) 
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3. 4. 2. 6 SET UP RM9100 (RMSET) 

The RMSST subroutine reacts tha window parameters of tha RM9100 back to 
thair original values* These are: 

IXSTRT - 0 

IXSTOP - 319 

IYSTRT - 0 

1YSTOP - 255 

FORMAT: CALL RMSET 
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3. 4. 2. 7 RESET RM9100 ORIGIN (RMSETO) 


This routine allows the user to set the RM9I00 origin parameters. 
Updating the y origin by one in a loop will give an illusion of vertical 
scrolling. This routine is used to scroll iaage data. 

FORMAT: CALL RMSETO (IXORG, ITORG) 
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3.4. 2. 8 RM9100 WRITE IMAGE (RMWRIM) 


Th« RMWRIM writes to any rectangular tree 
to 2000 pixels aey be written in any one call 
of the entire screen is used. 


in the RM9100, in word mode. Up 
to RMWRIM. The defeult window 


T f he LMEX Pf°* ram *» ICHNL always equals -1, ISCALE always equals 0 end 
I CTN always equals 0. ISCAN is the scan direction to be used for the write. 


ISCAN - 0 
ISCAN - 4 


primary - left to right 
secondary - top to bottom 

primary - top to bottom 
secondary - left to right 


„„„ IXS * re tt,e line .t.rt where the write to memory is the 
occur. IDATA ,. the buffer eddrea. of the element(s) to be written aodU£N 
is the number of pixels to be written. 

FORMAT: CALL RMWRIM UCHNL, ISCAN, ISCALE, IFCTN, IXS, IYS, IDATA, ILEN) 


3. 4. 2. 9 ISSUE WAIT FOR QUEUE I/O (WIO) 

The WIO subroutine issues a PDP 11/70 WTQIO system directive. There are 
two arguments passed to this routine, IFCTN and IDEV. IFCTN specifies the I/O 
function to be executed and IDEV ia the device in which the I/O function is to 
occur . 

This subroutine is used for all RM9100 I/O. The couaon block 10 contains 
the other parameters required by the WTQIO instruction. 

FORMAT: CALL WIO (IFCTN, IDEV) 

FUNCTION CODES: "410 - Write Logical block (RM9100) 

"1010 - Read Logical block (RM9100) 




